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I.  INTRODUCTION 


A.  BACKGROUND 

Vibration  is  defined  as  “periodic  back-and-forth  motion  of  the  particles  of  an 
elastic  body  or  medium,  commonly  resulting  when  almost  any  physical  system  is 
displaced  from  its  equilibrium  condition  and  allowed  to  respond  to  the  forces  that  tend  to 
restore  equilibrium”  [1].  Aircraft,  automobiles,  buildings,  bridges,  etc.  all  require 
significant  consideration  to  vibration  analysis  in  their  design.  To  minimize  vibrations  in 
automobiles  and  improve  driver  comfort,  shock  absorbers  are  incorporated  into  the 
suspension.  Skyscrapers  such  as  Taipei  101  Tower  use  tuned  mass  dampers  to  reduce  the 
amplitude  of  vibrations  imposed  by  forces  from  wind  to  earthquakes  by  absorbing  kinetic 
energy  [2].  Simply  making  a  system  more  rigid  with  more  structural  components,  screws, 
bolts,  welds,  etc.  is  another  way  to  reduce  vibrations  [3]. 

Vibration  design  consideration  for  spacecraft  is  no  different.  In  the  launch 
environment,  the  launch  as  well  as  the  payload,  undergoes  significant  stresses  and 
vibrations.  When  the  spacecraft  is  on  orbit,  any  appendage  movement,  such  as  unfurling 
the  payload,  an  antenna  arm  slew,  camera  slewing,  or  solar  panel  deployment  can  impart 
vibrations  on  the  entire  spacecraft.  Vibrations  on  a  spacecraft  affect  the  components  and 
structural  integrity,  but  also,  for  example,  the  pointing  accuracy  of  an  imaging  system  or 
an  antenna’s  communication  link.  On  Earth,  a  system  can  generally  be  fixed  or  repaired 
in  the  event  of  a  mishap  or  complication  resulting  from  excess  vibrations;  however,  after 
a  spacecraft  is  on  orbit,  one  does  not  have  that  luxury.  Spacecraft  and  satellites  are 
complex  systems.  Robust  spacecraft  design  and  testing  must  be  conducted  on  the  ground 
to  ensure  the  system  will  continue  to  operate  within  specifications  during  all  regimes  it 
encounters  in  its  design  life.  Figure  1  illustrates  the  complexity  of  satellite  antenna  arms 
in  the  Tracking  and  Data  Relay  Satellite  (TDRS). 
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Figure  1.  Tracking  and  Data  Relay  Satellite  (TDRS).  Source:  [4], 

A  challenge  with  space  systems  is  that  it  costs  a  lot  of  money  to  put  a  satellite  or 
spacecraft  into  space.  Estimates  to  send  one  kilogram  of  mass  into  low  Earth  orbit  range 
from  $2,720  for  a  SpaceEx  Falcon  9  [5]  to  $20,200  for  an  Atlas  V  [6].  With  this  said, 
designing  a  rigid  spacecraft  with  components  used  for  vibration  reduction  introduces 
more  mass  to  the  system  and  therefore  more  cost  as  well.  Alternately,  a  design  choice  to 
manage  spacecraft  vibrations  is  to  control  appendage  deployment  or  antenna  arm  slew 
rates.  However,  what  if  a  program  required  a  satellite  camera  to  take  more  pictures  as  it 
flew  from  horizon  to  horizon?  What  if  the  specification  for  the  rate  of  an  antenna  to 
establish  a  link  with  a  ground  site  or  other  satellite  was  twice  that  of  previous  designs? 

These  demands  can  be  met  if  there  is  a  way  to  control  vibrations  without  adding 
mass.  Furthermore  improving  vibration  control  methods  for  satellites  that  are  already  on 
orbit  through  software  change,  and  thereby  increasing  their  performance,  allows  that 
performance  to  be  extended  without  the  costs  of  designing  and  launching  an  entirely  new 
system.  Developing  new  motion  control  systems  that  optimize  movement  in  a  way  that 
manages  vibrations  is  indeed  possible  as  evidenced  by  recent  work  at  the  Naval 
Postgraduate  School  [7],  [8].  Numerous  papers  have  been  dedicated  to  the  development 
of  flexible  space  systems.  In  Steven  Wojdakowski’s  2015  thesis  [7],  he  developed  models 
for  two  degree  of  freedom  flexible  and  double  gimbal  systems.  However,  there  is  little  to 
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no  evidence  of  work  dedicated  to  building  a  two  degree  of  freedom  system  with  rigid 
links,  yet  a  purposefully  flexible  joint  in  a  laboratory  setting. 

In  order  to  transition  these  ideas  into  practice  they  must  be  thoroughly  vetted  in 
the  laboratory.  Thus,  the  goal  of  this  thesis  is  to  develop  a  laboratory  test  bed  for  testing 
the  new  ideas. 

B.  OBJECTIVE  AND  SCOPE 

This  thesis  focuses  on  the  development  of  a  simple  laboratory  test  bed  that  can  be 
used  to  test  new  ideas  for  control  of  flexible  space  systems.  An  understanding  of  the 
concepts  is  illustrated  through  the  construction  of  a  multi-body  system  involving  a  two- 
DOF  robot  arm  mounted  to  a  base  plate  with  a  flexible  joint  appendage  also  mounted  to 
the  base  plate.  In  order  to  produce  the  forces  necessary  to  observe  vibration,  three  flexible 
joint  concepts  were  developed  while  incorporating  a  previously  developed  two-link 
robotic  arm  with  electric  actuators  mounted  to  an  air-bearing  test  bed.  The  test  bed,  when 
applied  with  air  pressure,  rotates  freely  when  excited.  Figure  2  shows  the  test  bed  early  in 
the  development  process  that  was  developed,  designed,  and  tested  as  part  of  this  thesis. 


Figure  2.  Laboratory  Test  Bed  Early  in  the  Development  Process 
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The  test  bed  provides  researchers  the  capability  of  designing  and  testing  concepts 
such  as  optimal  control  methods  in  a  laboratory  setting  so  they  can  be  transitioned  to 
present  and  future  space  systems.  In  all  experiments  and  modeling,  it  is  assumed  that  the 
moving  links  are  rigid;  that  is,  only  the  joints  are  considered  flexible.  Design  of  these 
joints  forms  a  large  part  of  the  development  work  of  the  thesis.  In  all,  three  flexible  joint 
concepts  were  designed  to  perform  the  experimentation.  The  first  and  second  concepts 
use  traditional  elastic  springs  in  varying  configurations  while  a  third  uses  a  specially 
machined  torsional  spring.  Additionally,  inertia  measurement  units  and  an  embedded 
computer  were  incorporated  for  system  response  measurement  and  data  analysis. 
Through  experimentation,  a  basis  for  future  thesis  work  is  developed  to  demonstrate  how 
optimal  control  trajectories  can  be  used  to  minimize  vibrations  in  spacecraft  slewing 
maneuvers. 

Starting  with  the  two-link  arm,  a  standard  maneuver  will  be  designed  using 
optimal  control.  The  control  torques  used  to  move  the  ann  impose  a  disturbance  onto  the 
flexible  links.  To  assess  this  disturbance,  a  simple  model  is  built.  The  model  parameters 
will  be  adjusted  to  help  bracket  constants  for  design  of  a  flexible  joint  suitable  for 
laboratory  demonstrations.  Different  approaches  can  be  used  to  minimize  vibrations  on 
appendages.  Simply  reducing  the  slew  rates  on  an  antenna  arm,  which  is  common 
practice  in  industry  today,  will  reduce  vibrations.  Although  not  tested  in  this  thesis,  the 
optimal  control  method  can  also  be  used  with  a  model  of  the  entire  system  to  reduce 
vibration  without  reducing  slew  rates.  The  test  bed  is  designed  to  enable  experimentation 
to  compare  and  contrast  the  various  techniques. 

C.  THESIS  OUTLINE 

To  demonstrate  the  background  for  the  test  bed  Chapter  II  starts  the  thesis  with  a 
discussion  of  optimal  control  theory  for  a  2DOF  robotic  ann  slew  through  90  degrees. 
Chapter  III  uses  the  torque  profile  for  the  time-optimal  trajectory  found  in  Chapter  II  as 
the  basis  for  a  model  to  predict  the  amount  of  displacement  that  can  be  expected  from  the 
flexible  system  for  such  a  maneuver.  In  Chapter  IV,  the  details  of  the  test  bed  design  and 
assembly  are  discussed  as  well  as  the  data  processing  procedures  to  measure  the  vibration 
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response.  Finally  in  Chapter  V,  the  experimental  results  for  each  concept  are  illustrated 
ending  with  a  decision  on  the  appropriate  flexible  joint  and  post-processing  methods  to 
be  used  in  future  work.  Conclusion  on  future  work  is  discussed  in  Chapter  VI. 
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II.  OPTIMAL  CONTROL  OF  A  TWO-LINK  ROBOT 


Chapter  II  investigates  time  optimal  control  of  a  two-link  2DOF,  planar  ann.  To 
begin,  the  equations  of  motion  for  the  system  are  developed.  The  experimental  hardware 
and  software  used  to  implement  the  trajectory  is  then  detailed.  Finally,  with  the  equations 
of  motion  derived  and  scaled  and  parameters  of  the  hardware  and  software  incorporated, 
time  optimal  control  methods  are  examined  to  produce  an  optimal  trajectory  for  a  90- 
degree  slewing  maneuver.  The  motion  profile  obtained  this  chapter  is  a  version  of  the 
industry  standard  where  each  appendage  of  a  spacecraft  is  considered  separate  from  the 
others.  Interaction  between  the  various  appendages  is  not  considered. 

A.  EQUATIONS  OF  MOTION 

The  equations  of  motion  were  developed  for  a  two-degree  of  freedom  (2DOF), 
two-link  planar  robotic  arm  to  provide  a  basic  model  for  the  movement  of  a  satellite 
antenna  or  other  appendage.  It  was  assumed  at  present  that  the  links  and  joints  are  rigid; 
i.e.,  a  rigid-body  system.  Figure  3  illustrates  the  setup. 


Figure  3.  Rigid-Body  2DOF  Planar  Robot.  Source:  [9]. 
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The  kinematic  and  dynamic  equations  of  motion  for  the  movement  of  a  2DOF 
planar  robotic  arm  were  obtained  from  reference  [9]  and  are  shown  in  (2.1)  and  (2.2).  It 
was  assumed  that  the  movement  of  the  arms  was  in  the  horizontal  plane,  i.e.,  parallel  to 
the  ground.  Therefore,  in  the  laboratory  setup,  gravity  terms  will  not  appear  in  the 
equations  of  motion.  By  eliminating  the  gravity  terms,  this  also  provides  a  better  proxy 
for  space  systems  considering  the  lack  of  gravity  in  outer  space.  Additionally,  the  robot 
ann  model  is  commanded  in  a  comparable  manner  to  a  satellite  antenna  arm.  That  is,  the 
robot  arm,  like  the  antenna  arm  must  travel  through  a  certain  trajectory  to  perfonn  a  slew 
maneuver  from  point-to-point. 


The  dynamic  model  of  the  robot  ann  is  given  by  [9]: 

7U|  j@|  +  7U|2@2  —  2/  0\@2  ~  f  ~~  C  (2  1) 

m22@i  T  T  r&i  —  f 2  (2-2) 

where  rxand  r2  are  the  torques  applied  at  each  joint,  0xand  02are  the  angles  displaced  of 
each  link  /1and  Z2  are  the  lengths  of  the  links,  d1  and  d2  are  the  distances  from  the  each 
joint  to  the  respective  joints  center  of  mass,  and  lt  and  /2  are  the  mass  moments  of  inertia 
of  each  link.  Equations  (2.3)  -  (2.5)  illustrate  the  derivation  of  these  values. 

n?i  |  =  /|  + 1 2  +  ni|/(  +  m2 (df  + l2  +  2dtd2  cos  02)  (2.3) 


m1 2  =  m2l  =  1 2  +  m2(l2  +dtl2  cos 02) 


m22  =  /  2  +  m2d 


(2.4) 

(2.5) 


The  parameter  V’  is  formulated  for  convenience  from  the  Christoffel  symbols,  which  are 
used  to  derive  the  Coriolis  matrix.  The  Christoffel  symbols  [8]  are  given  as: 

1  dmn 


CH1 


2  ae, 


=  o 


(2.6) 


—  1  =  -m2l,l2  sin d2 

2  d01  212  2 


(2.7) 


c122  =  Clm'2  -  —  ^ m 22  =  -m2/|/2  sin  02 
122  d02  2  ddt  212  2 


(2.8) 


8 


dmn  1  dmn  . 

c,,,  ==  - — LL  =  -m1/,Z2sin01 

211  30,  2  d02  212  2 

(2.9) 

c  =c  =l3ma=0 

2,2  221  2  ae, 

(2.10) 

_  1  3w22  _ 

222  2  d02 

(2.11) 

The  Coriolis  matrix  is  then  derived  from  the  Christoffel  symbols  and  defined  as: 

r  .  .  v 


C  =  -m2l  j/2  sin02 


02  0t  +  6  2 


e,  o 

\  / 

Thus,  the  parameter  V  is  obtained  from  the  Coriolis  matrix  as 


(2.12) 


r  =  m2/,/2  sintT 


(2.13) 


B.  LABORATORY  PROTOTYPE  ARM 

The  robotic  arm  linkage  developed  in  this  thesis  is  shown  in  Figure  4. 


Figure  4.  Prototype  Robot  Ann 
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The  links  were  created  in  Solid  Works  and  printed  using  the  Naval  Postgraduate 
School’s  (NPS)  3D  printer  of  polycarbonate  material.  The  joint  actuators  are  Dynamixel 
Pro  actuators;  model  M42-10-S260-R,  from  the  company  Robotis.  Each  actuator  has  a 
maximum  torque  rating  of  5.6  Nm  and  a  nominal  load  speed  of  28  RPM  [10].  The 
actuators  are  controlled  by  the  host  computer  via  Robotis  Dynamixel  Wizard  software.  In 
Dynamixel  Wizard,  multiple  actuators  can  be  commanded  at  once  to  set  torque,  velocity, 
and  position.  With  these  inputs,  the  user  chooses  the  goal  position,  and  the  actuators 
perform  the  maneuver  from  point.  Other  operating  modes  are  available  (such  as  torque 
control);  however,  position  control  is  the  default  and  most  appropriate  mode  to  control 
the  actuators.  Important  to  note,  there  is  not  a  mode  that  allows  multiple  commands  at 
once,  that  is,  a  time  series  of  inputs  that  would  allow  a  robot  arm  to  perform  something 
other  than  a  linear  “point  A  to  B”  trajectory.  To  enable  this  type  of  commanding,  custom 
software  needs  to  be  developed  to  drive  the  system.  Figure  5  shows  a  screenshot  of  the 
Dynamixel  Wizard  user  interface. 


Figure  5.  Dynamixel  Wizard  User  Interface.  Source:  [10]. 
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Measurements  were  made  to  detennine  the  parameters  of  the  robot.  The  length  of 
the  arms  was  measured  to  be  33  cm  and  each  arm  was  estimated  to  be  approximately  2.3 
kilograms.  The  link  parameters  are  summarized  in  Table  1. 

The  mass  moment  of  inertia  for  each  link  is  calculated  for  a  simple  beam  as: 

=  (2.14) 

12 

where  f  denotes  the  moment  of  inertia  of  link  i  about  an  axis  to  the  axis  of  joint  rotation 
(see  Figure  4)  and  passing  through  the  center  of  mass  of  link  Using  the  link 
measurements  given  above,  /  was  estimated  to  /=  0.021  kg-m2. 


Table  1.  Estimated  Link  Parameters  of  a  2DOF  Robot 


Length  (m) 

Mass  (kg) 

Inertia  ( kg  *  m2) 

Individual  Link 

0.33 

2.3 

0.021 

C.  TIME  OPTIMAL  CONTROL  OF  THE  2-DOF  ARM 

Optimal  control  can  be  applied  for  cases  of  minimum  effort  but  the  case  of 
minimum  time  causes  the  largest  disturbance  to  the  spacecraft.  This  is  because  minimum 
time  solutions  are  bang-bang  in  nature.  Therefore,  for  the  purposes  of  this  thesis,  time 
optimal  control  was  considered.  The  problem  formulation  and  subsequent  derivation 
make  use  of  the  methods  discussed  in  reference  [11]. 


1,  Problem  Formulation 


For  the  dynamic  model  described  in  section  A,  the  state  variables  and  control 
variables  can  be  defined  as: 


_ 1 

'0,  " 

o2 

o2 
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(2.15) 


Optimal  control  is  applied  for  a  minimum  time  problem  by  a  cost  functional  as: 
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(2.16) 


The  time  optimal  control  problem  uses  to  the  dynamics  in  (2.1)  and  (2.2).  To  form 
the  state-space  model  for  each  link’s  acceleration,  (2.1)  and  (2.2)  are  solved  for  9{  and 
02 ,  respectively  as: 


T,  mn  2r(O,(O0  rC07 

ax  =— - —  a2  + - —  + — - 


m 


ii 


in 


ii 


(2.17) 


t2  m  „  r  2 

a2  =— - —a, - £0[” 


(2.18) 


where  0,  =  cox  and  02  =  co2  and  where  0,  =  =  at  and  02  =  cb2  =  a2. 

By  substituting  (2.18)  into  (2.17),  we  arrive  at: 


ax  = 


— - (t,  -  t2  +  rtuf  +  2rcolco2  +  rco2 ) 

_  I'M  '  ' 


(2.19) 


Similarly,  by  substituting  (2.17)  into  (2.18),  we  arrive  at: 


oc2 


m. 


m 


22 


m 


22 


2  r(Ofi)2 


m 


m. 


—real  -real 


(2.20) 


2.  Scaling  the  Dynamic  Equations 

Scaling  is  used  to  condition  the  problem  numerically.  Using  the  values  assumed 
for  link  length  and  mass  as  a  length  unit  and  a  mass  unit,  respectively,  an  inertia  unit  was 
detennined  as: 


IU  =  MU  *  LU 


(2.21) 


Since  angular  rate  is  a  function  of  angle  (referred  to  as  a  dimensionless  unit  of 
radians)  an  angular  rate  unit  is  derived  as  simply  the  angle  displaced  divided  by  time. 

6  6U 


coU  = 


time  TU 


(2.22) 
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Therefore,  we  may  choose  a  time  unit  is  used  as  simply  unity.  Consequently,  a 
scaled  torque  unit  simply  becomes  an  IU  divided  by  unity.  Table  2  illustrates  the 
canonical  units  derived  from  the  robot  arm  problem. 


Table  2.  Canonical  Units  for  a  Robot  Arm  Problem 


Length  Unit  (LU) 

0.33  m 

Mass  Unit  (MU) 

2.3  kg 

Inertia  Unit  (IU) 

0.08  kg-m2 

Torque  Unit  (TQU) 

0.08  Nm 

Time  Unit  (TU) 

1  sec 

Theta  Unit  (0U) 

6  rad 

Consequently,  the  scaled  parameters  of  the  system  become: 


d{  2  =  LU  *dl2 

(2.23) 

ml  2  =  MU  *ml  2 

(2.24) 

lu2  =  IU*Iia 

(2.25) 

U.2  =  TQU  **13. 

(2.26) 

Q)  =  Q)U*(d 

(2.27) 

where  coU  =  —  =  1 . 

TU 

The  following  illustrates  the  scaling  of  the  dynamic  equations: 
For  and  02: 


dO  _  dOUQ  _  6U  dO  _  OU  - 

(2.28) 

dt  ~  dTUt  ~  TU  dt~  TU 

euz  rr_  eu  _ 

— 0  =  coUco  =  — co 

(2.29) 

TU  TU 

0  =6) 

(2.30) 
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(2.31) 


The  LHS  for  d>1  and  d)2 is  scaled  as: 


v  .  dco  dcoUco  coU  dco  coU  - 

6  =  co  =  —  = - —  = - —  = - co 

dt  clTUt  TU  dt  TU 

The  RHS  for  co1  and  d>2  is  scaled  as  (note  to  reader,  recall  that  terms  mij  are  inertia 
terms,  not  mass  terms): 

TQUt.-TQUt 2 
+MUm2LUTlLUT2  sin  62coU2d)f 


coU 


-CO, 


1 


TU  1  IUmn  -IUm 


22 


2MUm2LUllLUl2LUl2sm02coU2colco2 

2rz22 


MUm2LU\LUl2LUl2  sin 02coUzdj;) 


(2.32) 


The  first  term  of  (2.32)  is  scaled  as: 

TQUt1 


MULU 2 


TU 


2  h 


IU (m,  j  -  m22 )  MULU °(m1 1  -  m22 ) 


(2.33) 


TU 


Dividing  through  by -  gives: 

coU 


MULU 2 


TU 
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MULU 1 


TU 


TU 


2 


TU 


MULU2(mu  —fh22)  coU  MULU\mn-m22)  OU 


(2.34) 


TU 


All  terms  cancel  leaving: 


(2.35) 


(mn  -  m22) 

Similar  results  are  derived  for  the  second  term  of  (2.32).  For  the  third,  fourth,  and 
fifth  tenns  of  (2.32),  the  first  term  in  the  parenthetical  expressions  are  considered  only  as 
the  other  terms  in  the  parentheses  have  the  same  units.  As  well,  as  was  done  in  the 
scaling  of  the  first  term  of  (2.32),  the  right  hand  side  of  (2.36)  incorporates  the  division  of 
TU  TU2 


cou  eu 


.  With  this  said,  (2.36)  shows  the  scaling  of  the  third  term  of  (2.32): 


TU2 


GU 
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MULU\mu  -  m22) 


MUm2LUlxLUl2  %\x\GxcoU2cd] 


(2.36) 


All  terms  cancel  to  give: 
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(2.37) 


m2  /,  4  sin  02  2  _  )'ft>, 

(mM  -m22)  1  (mn-m22) 

In  all,  the  fourth  and  fifth  terms  are  scaled  in  a  similar  fashion  to  arrive  (finally)  at  the 

scaled  equation  for  ch, : 


ft),  =  0,  =— —  (t,  —  f2  +  ror  +  2rft>,ft)2  +  rft)2) 


(2.38) 


Similarly  forft)2 : 


•  /-j  772  ■  ■  / —  ^92  —  ^22  ^  —  —  —  ^22  — — 2  — — 2\  /o  or\\ 

co2=02=  _  — _  _  (t2  -  ~—r^rco2  -  rco (2.39) 


where  r  is:  r  =  m2/,/2  sin02 . 

The  dynamic  equations  can  now  be  written  in  their  scaled  form  as: 


0,  =  ft), 

02  —  ©2 


to,  =  a. 


(t,  -  T2  +  r  ft),2  +  2r  ft),ft)2  +  rft>2] 


(2.40) 


to2  =  a,  =  _ 


_  T2-^T,-^2rft),ft>2-^rft>2  -rft). 


3.  Boundary  Conditions 

The  boundary  conditions  for  the  rest-to-rest  motion  are  modeled  as  zero  critical 
angular  velocity  and  zero  final  angular  velocity  for  each  link.  The  boundary  conditions 
for  initial  position  x-y  to  final  position  x-y  use  the  model  kinematics  based  off  of  link 
length  and  angular  displacement  of  each  link.  Equations  (2.41)  -  (2.49)  illustrate  these 
conditions. 


®,o=0 


(2.41) 


ft)20  0 


(2.42) 


colf  =  0 


(2.43) 
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©2/=  0 

(2.44) 

dx  cos  Gw  +  d2  cos (0IO  +  020 )  =  x0 

(2.45) 

dl  sin0lo  +  d2  sin(0lo  +  02O )  =  y0 

(2.46) 

d1  cos  6/  +  d2  cos  (0,  f+02f)  =  xf 

(2.47) 

d1  sin  0,  f  +  d2  sin(0t  f+02f)  =  yf 

(2.48) 

o 

II 

o 

(2.49) 

The  values  of  x0,  Xf,  y0  and  yf were  established  to  establish  a  joint  space  trajectory 
moving  through  90-degrees. 

In  order  to  solve  the  optimal  control  problem,  Pontryagin’s  principle  is  applied  as 
outlined  in  [11].  A  control  Hamiltonian  is  created  by  relating  any  running  cost  function 
and  the  co-state  vectors  with  the  state  dynamics.  The  Hamiltonian  is  then  minimized  with 
respect  to  the  control  variable  to  arrive  at  a  relationship  between  the  control  variable  to 
the  co-state  dynamics.  An  intennediate  step  to  develop  adjoint  equations  is  then  applied 
to  determine  the  co-state  dynamics.  The  concept  of  transversality  is  applied  by  taking  the 
partial  derivative  of  the  end  point  cost  function  and  end-point  equation  with  respect  to  the 
end  states  to  derive  relationships  that  will  serve  to  aid  in  solving  the  adjoint  equations. 
The  Hamiltonian  minimization  condition  uses  these  results  to  solve  for  the  ultimate  goal 
of  the  control  trajectory. 

4.  Formulation  of  the  Hamiltonian 

In  formulating  the  Hamiltonian  H  —  F  +  AT f,  F  is  the  running  cost,  X  is  a  vector 
of  co-states,  and /is  a  vector  of  the  state  dynamics  equations.  For  the  case  of  the  time 
optimal  control  problem,  the  running  cost  is  zero  and  the  end-point  cost,  E,  is  simply  /. 
The  Hamiltonian  is  therefore: 
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(2.50) 
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By  observation,  the  appearance  of  control  torque  in  the  Hamiltonian  is  linear.  As 
a  consequence,  when  the  Hamiltonian  is  minimized  with  respect  to  each  control  variable, 
dH 

i.e.  the  partial  -  is  evaluated,  the  control  torques  disappear.  Therefore,  to  obtain  an 

dti 

expression  for  the  control  torques,  the  Hamiltonian  minimization  condition  (HMC)  is 

dH 

interpreted  as  a  switching  function  [12].  The  torque  is  defined  by  the  behavior  of  —  = 

5).  As  noted  earlier,  the  maximum  torque  that  can  be  applied  by  the  two-link  arm 
actuators  is  5.6  Nm.  We  now  evaluate  the  switching  functions. 

For  f]  from  (2.15)  we  have: 


3t,  mu-m2 


co\m2lmn-m22mn 


(2.51) 


which  specifies  the  torque  as  follows: 


S2  >  0: 


ll  imin 


<  0:  T2  T-max 


Similarly,  for  T2from  (2.15): 


dH  =  -K,  ^  K2mu 

df2  mu-m22  m2l(mu-m22) 


(2.52) 


giving: 


>  0.  T2  T-min 


S7  <0:  T?  —  T 


2  Lmax 
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5. 


Adjoint  Equations 


With  the  Hamiltonian  minimized  the  adjoint  equations  must  be  created  to  define 
the  co-state  dynamics  equations  that  allow  the  switching  functions  to  be  evaluated  and 
additionally  to  gain  insight  to  the  satisfaction  of  the  conditions  of  Pontryagin’s  principle. 
The  adjoint  equations  are  developed  as: 

=  (2.53) 

ox 


Since  the  equations  of  motion  do  not  have  terms  as  a  function  of  01;  therefore,  we  arrive 
at  the  value  above.  From  (2.54),  we  can  conclude  that: 

Ae  =  constant  (2.55) 

What  will  be  found  later  is  that  the  constancy  of  the  Hamiltonian  [11]  and  the  fact 
that  Adi  =  constant  will  be  the  key  indicators  for  optimality  regarding  the  satisfaction  of 
Pontryagin’s  principle. 

*  dH 

Considering  d2,  the  adjoint  equation  —  Ae  —  — ,  gives  many  terms  due  to  the  fact 

2  o02 

that  7  =  m2/,/2  sin6f  ,  which  appears  in  the  equations  of  motion,  and  subsequently  in  the 
Hamiltonian.  With  this  said,  the  equation  for  —  Aq2  becomes  very  complicated.  The 
equation  does  not  give  intuition  as  to  the  behavior  of  the  co-state  trajectory;  that  is,  if  the 
plot  were  that  of  an  optimal  or  non-optimal  solution.  Due  to  the  complicated  nature  of  the 
dynamics,  similar  complicated  equations  are  found  for  A0}±  and  Aa)2;  therefore,  those 
adjoint  equations  also  don’t  give  a  useful  way  to  verify  the  optimality  of  the  system. 
Additionally,  it  was  illustrated  earlier  that  the  switching  functions  also  include  the  terms 
A0Jl  and  Aa>2.  With  this  said,  the  one  could  compute  the  values  of  St  to  check  that  the 
controls  perform  in  the  correct  manner. 
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6.  Transversality 

The  pencil  to  paper  fonnulation  of  transversality  is  conducted  for  thoroughness, 
but  in  this  case  was  not  needed  since  the  end  conditions  are  known.  However,  if 
transversality  results  are  not  considered  with  this  observation  (i.e.,  that  derivation  of  the 
transversality  conditions  are  not  useful)  then  we  know  the  something  may  be  wrong  with 
our  problem  formulation  on  our  subsequent  analysis. 

The  steps  to  developing  the  transversality  conditions  are  shown  as  follows. 

%)  =  |^  (2.56) 

where  E  —  E  +  vre(x(t^) ).  Equation  e(x(tf  ))  provides  the  end-point 

conditions. 

Since  for  the  minimum  time  problem  we  have: 


co,  -0 

V 

co  7  -  0 
e  = 

J,  cos  f  +  cl2  cos  (0,  f  +  d2f)  —  xf 
<:/,  sin  0,  f  +  cl2  sin(0j  f  +  02f)-yf 

We  may  write: 

tf  +  Vx(0xf+V2(02f 

E  =  +v3(dx  cos  6XJ  +d2  cos  (dlf  +  d2f)  —  xf) 
+v4  (dx  sin  6X  f  +  d2  sin(0, ,  +  02  f )  -  y  f ) 


(2.57) 


(2.58) 


Taking  the  partial  of  E  with  respect  to  the  state  variables  at  the  final  time  gives: 


V*/)= 


c)E 

d6if 


v3(-dx  sin0, /01 1  +  d2  sin(0, ,  +  02  f  )dyf  ) 
+v4  (d3  cos  0,  f6lf  +  d2  cos (0lf  +  02f  )6l  f) 


^02  (^/') 
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dd 
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(2.59) 

(2.60) 
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(2.61) 


K,  (ff )  - 
Ko2  (ff  ) = 


dE 

d(Olf 


=  Vj 


9ff 

du>2/ 


(2.62) 


As  is  seen  in  section  6,  each  partial  derivative  provides  an  unknown  constant. 
Thus,  the  analysis  does  not  provide  any  insight  that  can  be  used  to  validating  an  optimal 
solution.  Moreover,  since  the  transversality  conditions  provide  no  new  information,  we 
may  conclude  that  the  boundary  conditions  for  our  problem  have  been  properly  specified. 


7.  Solving  the  Optimal  Control  Problem 

To  perfonn  the  optimal  control  computation,  the  program  DIDO  was  utilized 
[11],  [13].  The  model  was  coded  to  allow  a  trajectory  that  spanned  360  degrees;  that  is, 
there  were  no  path  constraints.  With  this  said,  the  scenario  illustrated  in  the  following 
discussion  addresses  the  arm  moving  from  a  position  on  the  x-y  plane  of  (2,  0)  to  (0,  2) 
where  the  distance  traveled  is  in  length  units  (LU).  Figure  6  illustrates  the  trajectory. 


Figure  6.  Robot  Ann  Movement  in  the  x-y  Plane 
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Additionally,  the  model  was  run  using  20  nodes.  The  values  gained  from  this 
simulation  were  then  used  as  a  “guess”  for  a  simulation  using  60  nodes.  Using  60  nodes 
allows  one  to  arrive  at  a  more  refined  solution. 

8.  Results 

Figures  7-11  represent  the  minimum  time  solution  obtained  from  DIDO  for  the 
scenario  depicted  in  Figure  6.  Figure  7  shows  that  the  maximum  torque  that  could  be 
applied  to  the  model  is  saturated  to  5.6  N-m.  This  saturation  value  is  consistent  with  the 
bounding  value  entered  into  the  DIDO  code.  It  turns  out  that  if  a  higher  value  of  torque 
was  allowed  in  the  bounds,  a  non-optimal  solution  or  non-feasible  solution  was  returned. 
As  noted  in  the  boundary  conditions  section  of  this  chapter,  the  problem  needs  reasonable 
bounds  for  DIDO  to  narrow  its  search  for  the  optimal  solution.  If  the  range  of  torques,  in 
this  case,  is  too  high,  there  are  too  many  solutions  and  therefore  an  optimal  solution  can’t 
be  determined.  This  infeasibility  is  true  in  real  life  as  well.  Large  amounts  of  torque 
would  cause  high  stresses  on  system  components  leading  to  increased  failure  rates.  Large 
torques  could  also  lead  to  large  amounts  of  jitter  when  attempting  to  stop  an  antenna  slew 
therefore  affecting  pointing  accuracy.  Thus,  realistic  bounds  must  always  be  defined  to 
ensure  a  reasonable  solution. 
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Figure  7.  Minimum  Time  Torques  versus  Time  for  Trajectory  (x,y)  =  (2,0)  to 

(x,y)  =  (0,2) 
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Figure  8  shows  the  state  dynamics  of  the  optimal  control  solution  overlaid  onto 
the  validation  and  verification  (V&V)  solution.  The  V&V  solution  was  obtained  by 
running  the  trajectory  obtained  from  DIDO  through  a  numerical  model  [10].  For  the 
V&V,  initial  values  of  the  states  were  entered  into  an  ode45  numerical  integrator  along 
with  a  new  time  vector  that  used  smaller  incremental  time  deltas  compared  to  the  nodal 
time  vector  determined  by  DIDO.  This  assisted  in  the  interpolation  of  the  DIDO  time 
vector.  Additionally,  the  V&V  uses  the  optimal  torque  vectors  (that  is  the  control 
parameters)  and  propagates  them  through  the  state  dynamics  defined  in  the  problem 
statement.  A  comparison  of  DIDO  state  trajectories  and  the  V&V  state  trajectories  can 
then  be  seen.  Referring  to  Figure  8,  one  can  see  that  the  model  indeed  performs  in  a  rest- 
to-rest  manner.  The  variations  between  the  DIDO  solution  and  the  V&V  could  be 
reduced  with  an  increased  number  of  nodes,  or  by  using  a  feedback  controller  to 
implement  the  optimal  joint  trajectories. 


Figure  8.  Minimum  Time  State  Trajectories  for  (x,y)  =  (2,  0)  to  (x,y)  =  (0,  2) 
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One  curious  observation  is  the  angular  displacement,  0{ ,  and  angular  velocity, 
col  of  link  one.  From  Figure  8,  one  can  see  that  link  one  does  not  begin  to  move  until 
approximately  0.75  seconds.  This  demonstrates  an  advantage  of  using  computers  to  solve 
optimal  control  problems.  The  obvious  solution  where  one  would  assume  the  links  should 
always  be  moving  is  not  always  apparent,  but  with  advanced  computing  power,  unique 
solutions  that  could  not  otherwise  be  determined  are  discovered. 

Figure  9  shows  the  co-states  and  that  A^is  constant  over  the  simulation  time.  This 
constancy  is  an  indicator  of  optimality  in  accordance  with  Pontryagin’s  principle. 


Figure  9.  Minimum  Time  Co-states  Trajectories  for  (x,y)  =  (2,  0)  to 

(x,y)  =  (0,2) 
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Lastly,  Figure  10  illustrates  a  Hamiltonian  that  is  relatively  constant  near  a  value 
of  iH  =  -1’  as  would  be  expected  for  a  minimum  time  problem.  The  jump  mid-way 
through  the  simulation  indicates  a  non-ideal  portion  of  the  solution  that  typically  is 
observed  when  a  switch  occurs  between  the  nodes. 


Hamiltonian  vs.  Time 


Figure  10.  Minimum  Time  Hamiltonian  for  Trajectory  (x,y)  =  (2,0 

to  (x,y)  =  (0,  2) 


25 


Figure  11  shows  the  optimal  trajectory  overlaid  onto  the  V&V  solution  in  the 
robot  task  space;  i.e.,  the  Cartesian  plane.  It  is  interesting  to  note  that  the  trajectory 
between  the  start  and  end  points  is  not  an  arc,  as  one  would  anticipate.  From  this  plot,  it 
is  also  apparent  that  a  simple  propagation  of  the  open-loop  controls  doesn’t  move  the 
robot’s  end-effect  to  exactly  the  right  spot.  Closing  the  loop  (as  is  done  in  practice)  or  re¬ 
solving  the  optimal  control  problem  with  more  stringent  tolerances  (e.g.,  a  higher  number 
of  nodes)  would  resolve  this  issue. 


Figure  11.  Minimum  Time  Robot  Trajectory  in  the  Task  Space  for  Movement 

from  (x,y)  =  (2,0)  to  (x,y)  =  (0,2) 
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D. 


SUMMARY 


Through  formulation  of  a  time  optimal  slew  for  a  2DOF,  planar  robot  arm. 
Chapter  II  established  a  solution  around  which  to  model  the  development  of  the 
experimental  test  bed.  The  optimal  trajectory  that  was  detennined  in  this  section  is  an 
example  of  the  power  of  computers  to  find  a  better  solution  than  what  our  intuition  might 
tell  us  and  as  such  is  not  exactly  the  same  as  the  standard  maneuver  that  industry  would 
perform.  That  is,  the  time  optimal  path  is  not  simply  a  great  circle  rotation,  but  in  fact  a 
more  elegant  path  with  varying  torques  at  varying  time  steps  to  produce  a  better  solution. 
With  this  said,  the  model  presented  in  this  chapter  does  not  account  for  vibration  analysis, 
but  simply  provides  a  basis  to  see  how  an  optimal  path  performs  as  compared  to  a  basic 
rotation  of  a  two  link  robot  arm.  As  stated  in  the  Introduction  to  this  thesis,  one  method  to 
reduce  vibrations  is  to  reduce  the  applied  torque  and  therefore  the  slew  time  for  a  given 
trajectory.  With  this  said,  the  time  optimal  code  was  run  a  second  time  but  with  a  torque 
input  to  each  actuator  of  2.8  Nm,  or  half  of  the  5.6  Nm  maximum  available  torque  from 
the  Dynamixel  Pro  actuators.  The  resulting  time  to  complete  the  maneuver  was  3.0 
seconds  vice  2.1  seconds  when  5.6  Nm  was  applied.  Thus,  vibrations  can  be  reduced  at 
the  expense  of  an  increase  in  maneuver  time.  In  Chapter  III,  the  results  of  this  chapter  are 
used  to  design  a  flexible  joint  with  the  consideration  of  the  maximum  torque.  For 
comparison  of  other  techniques  aimed  at  minimizing  vibrations,  the  reduced  torque 
results  will  also  be  analyzed. 
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III.  DEVELOPMENT  OF  A  FLEXIBLE  JOINT  MECHANISM 


Chapter  III  focuses  on  the  development  of  the  experimental  system  mechanical 
components,  namely  a  flexible  joint  for  the  vibrating  appendage.  To  form  a  basic 
understanding  of  the  requirements  for  the  flexible  joint  concepts,  the  chapter  begins  with 
a  discussion  of  the  test  bed’s  air-bearing  and  base  plate.  From  there,  a  simple  model  is 
developed  to  detennine  appropriate  torsional  spring  rates  required  to  produce  a  desired 
deflection.  Chapter  III  continues  by  detailing  the  various  flexible  joint  concepts  that  were 
tried  before  arriving  at  the  concept  used  to  build  the  final  test  bed  configuration. 

A.  AIR-BEARING  TEST  BED 

With  the  flexible  joints  developed  for  each  case,  simple  simulations  were 
conducted  to  (i)  develop  the  process  to  analyze  data  from  the  test  bed  sensors,  and  (ii)  to 
get  a  sense  of  the  response  that  could  be  expected  from  the  free-rotating  system  when 
excited  from  another  robot  ann’s  motion. 

To  begin,  a  rotary  air  bearing  from  Nelson  Air  Corporation  was  used  to  mount  the 
support  plate  [14].  Figure  12  shows  the  air  bearing.  An  air  bearing  provides  for  a  near 
frictionless  rotation  in  the  horizontal  plane.  The  rotary  bearing  originally  incorporated  a 
large  magnet  in  the  internal  housing  to  motorize  the  motion;  however,  this  was  removed 
in  order  to  ensure  the  top  disk  could  rotate  freely  as  in  a  gravity-free  environment.  A  port 
with  tubing  is  seen  in  Figure  12  illustrating  how  pneumatic  pressure  is  applied  to  the  test 
set.  When  air  pressure  is  applied,  between  4.1  -  4.8  kPa  (60  -  70  psi)  as  specified  in  the 
test  specification  data  sheet  [14],  the  top  disk  rotates  freely  on  a  film  of  air  between  the 
two  air  bearing  surfaces. 
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Figure  12.  Single  Axis  Air-Bearing  Test  Set 
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B. 


BASE  PLATE  DEVELOPMENT 


An  aluminum  plate  was  constructed  to  mount  on  top  of  the  air  bearing  platter.  The 
aluminum  plate  was  designed  to  accommodate  robotic  linkages  on  opposite  sides  of  the 
plate  as  well  as  to  provide  tapped  holes  to  allow  a  means  for  integrating  future 
modifications  and  experiments.  The  maximum  overall  loading  of  the  air  bearing  is 
specified  at  454  kg.  The  plate  diameter  design  was  based  off  of  the  air-bearing  moment 
loading  specification  of  1730  kg-cm.  From  this  specification,  a  plot  was  created  to 
determine  how  far  the  test  bed  center  of  gravity  could  be  from  the  center  of  the  plate 
versus  the  amount  of  load  that  can  be  applied  at  the  center  of  gravity.  Figure  13  shows  the 
results. 


Test  Bed  Loading  vs.  Center  of  Gravity 


Figure  13.  Test  Bed  Capacity  versus  Base  Plate  Radius 
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Figure  13  illustrates  that  if  the  total  system  center  of  gravity  is  30.5  cm  from  the 
center  of  the  air-bearing,  up  to  56.6  kg  could  be  applied  at  that  center  of  gravity  before 
the  resulting  moment  would  cause  the  plate  to  be  out  of  balance,  and  therefore,  an 
interference  in  the  free-floating  rotation  of  the  plate.  The  total  weight  of  the  current 
system  is  approximately  3 1  kg  and  the  center  of  gravity  is  within  1  cm  of  the  center  of  the 
plate.  Therefore,  even  if  the  system  center  of  gravity  were  more  than  30.5  cm  from  the 
center  of  the  plate,  there  would  not  be  an  imbalance.  In  the  end,  a  30.5  cm  plate  radius 
was  chosen  due  to  two  reasons:  the  plot  shown  in  Figure  13  and  the  amount  of  space  that 
the  system  would  encompass  in  the  laboratory.  Furthermore,  Figure  13  shows  that  there 
is  a  significant  margin  between  the  current  mass  and  the  maximum  bearing  load  to  add  a 
second  level  incorporating  additional  components. 

Figure  14  illustrates  a  top  view  of  the  aluminum  base  plate  when  mounted  on  the 
air-bearing  test  set. 


Figure  14.  Aluminum  Plate  that  Supports  Robot  Arm  and  Flexible  Appendage 
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c. 


MODELLING  APPENDAGE  VIBRATIONS 


The  estimated  mass-properties  as  outlined  in  Table  1  were  used  to  determine  the 
dynamics  of  the  robot  arm.  Calculations  were  based  on  a  simple  beam  model  and  do  not 
account  for  actual  design  intricacies.  The  same  geometric  model  was  used  to  determine 
an  appropriate  value  for  a  torsional  spring  rate  so  a  one-arm  link,  with  the  flexible  joint, 
excited  by  the  two-link  arm  with  electrically  actuated  joints  would  produce  an  easy  to 
visualize  vibration  of  approximately  19  degrees  +/-  5  degrees.  For  the  initial  cut,  a 
constant  torque  was  applied  to  get  a  sense  of  how  the  system  may  perfonn.  Subsequently, 
the  optimal  control  profile  was  run  to  evaluate  how  that  trajectory  excites  the  vibration. 
The  main  point  behind  the  large  range  of  motion  is  to  visually  show  the  motion  of  the 
one-arm  link  flex.  Figure  15  illustrates  the  simple  torsional  mass-spring  model  formed  by 
a  rigid  plate  attached  to  a  spring  that  can  be  used  to  estimate  the  vibration  amplitude. 


Figure  15.  Simple  Torsional  Mass-Spring  System 

The  equation  of  motion  is  simply  derived  as: 

t  =  IO  +  kO  (3.1) 

and,  transfonned  into  the  Laplace  domain  becomes: 

t(s)  =  (Is2  +  k)G(s)  nn 
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The  open-loop  transfer  function  from  input  to  output  is: 


G(s)  = 


m 

F(S ) 


1 

Is2  +  k 


A  Simulink  implementation  of  this  model  is  illustrated  in  Figure  16. 


(3-3) 


Scope 1 

Figure  16.  Simulink  Model  for  Simple  Mass-Spring  System 


In  this  model  a  constant  input  of  5.6  Nm  was  applied  to  system  for  2.1  seconds 
then  the  applied  torque  is  commanded  to  zero.  The  time  frame  of  2.1  seconds  is  the 
optimal  time  determined  in  Chapter  II  for  the  robotic  arm  maneuver.  By  turning  the 
torque  off  after  2.1  seconds,  the  system  is  allowed  to  settle.  For  the  initial  analysis,  each 
simulation  was  run  for  15  seconds.  The  torque  value  of  5.6  Nm  is  the  maximum  torque 
capable  of  the  Dynamixel  Pro  actuator.  Figure  17  shows  the  response  of  a  flexible  link 
with  k  =  3.39  deg/Nm  and  /  =  0.21  kg-m 2 .  The  torsion  spring  rate  was  determined  by 
simply  dividing  the  desired  deflection  by  the  applied  torque. 

19  deq 

k  —  - - —  3.39  deg/Nm 

5.6  Nm  ,y/ 
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Figure  17.  Angle  and  Rate  Response  of  Flexible  System  Model  when  Subjected 
to  5.6  Nm  of  Torque  Using  Torsion  Spring  Rate  of  3.39  deg/Nm 


Referring  to  Figure  17,  one  can  clearly  see  that  for  the  constant  input  used,  the 
approximated  displacement  would  be  over  35  degrees.  This  response  would  be  too  large 
compared  to  what  was  desired.  Moreover,  only  one  actuator  on  the  two-link  arm  was 
considered  in  Figure  17  so  the  flexible  motion  would  be  much  larger  if  the  time  optimal 
solution  was  implemented. 
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As  a  comparison  to  other  techniques  used  in  industry  to  minimize  vibrations  of 
flexible  space  systems,  the  optimal  control  model  presented  in  Chapter  II  was  run  with  an 
applied  torque  of  half  of  the  maximum  torque  available  from  the  Dynamixel  Pro 
actuators.  The  time  to  complete  the  maneuver  of  the  planar,  2DOF  robot  arm  increases 
from  2.1  seconds  to  3.0  seconds  with  torque  reduced  from  5.6  Nm  to  2.8  Nm.  The 
reduced  torque  was  entered  into  the  same  model  used  to  produce  Figure  17.  Figure  18 
illustrates  the  results. 


Figure  18.  Response  of  Flexible  System  Model  with  Torque  Reduced  to  2.8  Nm 

By  comparing  Figures  17  and  18,  one  can  see  that  the  torque  reduction  (with  its 
unavoidable  increase  in  slew  time)  does  reduce  the  vibration  displacement  as  well  as  the 
magnitude  of  angular  rate.  This  technique  is  satisfactory  to  reduce  vibration,  but  for  our 
interests,  faster  slew  times  coupled  with  minimized  vibrations  are  desired. 
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To  find  an  appropriate  spring  rate  for  the  flexible  joint,  the  time  optimal  control 
trajectory  developed  earlier  was  approximated  using  three  steps.  The  torque  of  each 
actuator  from  the  time-optimal  control  trajectory  was  added  together  to  give  the 
approximated  optimal  control  torque  profile  illustrated  in  Figure  19. 


Figure  19.  Approximate  Torque  Trajectory  Compared  to  Total  Time  Optimal 

Control  Torque  Trajectory 
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This  step-wise  approximation  can  be  seen  to  be  a  sufficient  model  of  the  system 
and  to  allow  spring  rates  to  be  adjusted  to  obtain  the  desired  deflection.  Figure  20 
illustrates  the  results  for  a  torsion  spring  rate  of  1.7  deg/Nm.  The  torsion  spring  rate  was 
determined  by  simply  dividing  the  desired  deflection,  19  deg,  by  the  combined  applied 
torque  of  two  actuators,  1 1 .2  Nm. 


19  deg 
11.2  Nm 


1.7  deg/Nm 


Figure  20.  Angle  and  Rate  Response  of  Flexible  System  Model  when  Subjected 
to  the  Torque  Profile  of  Figure  19  Using  a  Torsion  Spring  Rate  of 

1.7  deg/Nm 


The  overall  angle  response  in  Figure  20  still  was  larger  than  required:  over  35 
degrees.  The  model  was  run  again,  halving  the  1.7  deg/Nm  spring  rate  to  0.85  deg/Nm. 
Figure  21  illustrates  the  results. 
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Figure  21.  Angle  and  Rate  Response  of  Flexible  System  when  Subjected  to  the 
Torque  Profile  of  Figure  19  Using  a  Torsion  Spring  Rate  of 

0.85  deg/Nm 

In  Figure  21  one  can  see  that  the  desired  initial  response  of  approximately  19 
degrees  is  achieved.  The  model  does  show  the  angle  trajectory  displacing  over  25  degrees 
in  the  opposite  direction.  However,  the  simple  model  of  the  system  with  the  spring  rate  of 
0.85  deg/Nm  was  considered  sufficient  to  proceed  with  the  joint  design  and  sizing  of 
various  options  for  the  flexible  link.  These  options  are  described  in  section  D. 

D.  CONCEPT  A— JOINT  WITH  TWO  COUNTER  SPRINGS 

Concept  A  was  inspired  by  a  YouTube  video  describing  an  experiment  using  a 
flexible  joint  [15].  The  experiment  in  the  video  uses  control  methods  to  minimize  the 
vibrations  of  an  appendage.  Exact  methods  to  control  the  appendage  vibrations  were  not 
described,  but  the  experimental  set  up  provided  an  initial  concept  from  which  to  design  a 
flexible  joint.  Figure  22  is  a  simple  sketch  of  the  set  up. 
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Figure  22.  Simple  Sketch  Illustrating  Flexible  Joint  for  Concept  A 

This  concept  was  developed  as  one  possible  means  to  evaluate  the  response 
imparted  on  the  one-link  arm  from  the  two-link  electrically  actuated  arm.  A  key  feature 
to  this  design,  and  the  two  other  concepts  described  in  sections  E  and  F,  is  this  use  of 
bearings  as  part  of  the  joint.  The  bearings  shown  in  Figure  23  are  typically  used  with  the 
actuators  that  are  implemented  on  the  two-link  robot  ann  to  allow  appendage  rotation. 
The  repurposing  of  these  bearings  allows  for  smooth  rotation  to  the  flexible  joint 
concepts  [16]. 


Figure  23.  Photograph  of  Dynamixel  Pro  Bearing  Used  for  Flexible  Joint 

Concept  Designs.  Source:  [16]. 
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It  should  be  noted  that,  though  the  bearing  does  rotate  freely,  there  is  still  friction 
in  its  mechanism.  The  ball  bearings  that  allow  the  bearing  to  rotate  may  become  damaged 
or  dirt  may  become  stuck  in  the  rotating  component  introducing  non-linearities  to  the 
system.  At  the  very  least,  they  introduce  drag  that  will  reduce  the  amplitude  of  the 
vibration  over  time.  Figures  24  and  25  illustrate  the  developed  prototype  of  concept  A. 


Figure  24.  Concept  A — Side  View 


Figure  25.  Concept  A — Side  View  Close-up 
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Concept  A  seemed  to  be  simple  enough  in  the  sketching  phase.  The  main  idea 
was  to  attach  two  extension  springs  on  the  outboard  sides  of  the  mount  and  arm.  The 
concept  may  be  simple  on  paper,  but  the  actual  build  proved  to  be  more  difficult.  As  one 
can  see  from  Figure  25,  in  order  to  change  the  spring  to  investigate  varying  spring 
constants  and  therefore  different  responses,  the  mount  and  ann  have  to  be  taken  apart. 
This  is  a  time  consuming  process.  As  well,  in  early  experiments  to  test  the  basic 
functioning  of  the  concept,  the  springs  were  observed  to  buckle  in  compression;  that  is, 
become  concave  with  respect  to  the  outside  edge  of  the  mount  and  ann.  When  the  springs 
buckled  in  such  a  fashion,  it  was  assumed  that  non-idealities  would  influence  the 
response.  As  will  be  discussed  later,  the  actual  response  appeared  more  linear  than 
expected.  Table  3  lists  the  springs  that  were  utilized  for  initial  experimentation. 


Table  3.  Springs  Considered  for  Concept  A 


Length  (cm) 

Outside  diameter  (cm) 

Wire  diameter  (cm) 

Spring  rate  (kg/m) 

1 

0.478 

0.0406 

8.95 

1 

0.478 

0.0508 

29.2 

1 

0.478 

0.0635 

98.5 

To  get  a  sense  of  the  response  using  the  spring  rates  noted  in  Table  3,  the 
torsional  mass  spring  system  was  adjusted  to  account  for  the  fact  that  the  extension 
springs  are  being  used.  With  this  said,  the  force  transmitted  across  the  plate  replaced  the 
torque  term  by  simply  dividing  the  torque  trajectory  by  the  distance  between  the  bases  of 
the  two-link  arm  and  the  one-link  flexible  joint  arm.  As  well,  the  inertia  term  was 
replaced  by  mass.  Figure  26  illustrates  the  response  for  a  spring  rate  of  29.2  kg/m  with  a 
maximum  deflection  of  3  cm. 
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Figure  26.  Simulated  Response  of  Concept  A  Using  a  Spring  Rate  of 

29.2  kg/m 

The  amount  of  linear  deflection  corresponds  to  approximately  +/-5.2  deg  when 
the  deflection  is  considered  at  the  end  of  the  33  cm  vibrating  arm  as  shown  is  Figure  27. 
The  displacement  in  Figure  26  corresponded  visually  to  initial  experimentation  of  the 
system  leading  to  an  initial  conclusion  that  the  simple  model  provided  a  good 
approximation  of  the  actual  system  response  to  robotic  arm  movement. 

3  cm 

3  cm 

33  cm 

Figure  27.  Displacement  of  Vibrating  Arm 
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Due  to  the  difficulty  of  assembling  concept  A,  only  one  spring  set  was  tested.  In 
the  end,  the  main  purpose  of  this  prototype  was  to  provide  an  initial  test  of  the  concept. 
Although  it  did  not  produce  a  large  amount  of  deflection  when  perturbed,  it  proved  to  be 
useful  in  the  overall  laboratory  build  as  will  be  seen  later. 

E.  CONCEPT  B— SPRING  FLEXION  PIN 

Concept  B  built  upon  the  idea  of  concept  A  as  a  more  rigid,  interchangeable 
design.  For  this  concept,  a  pin  is  routed  through  posts  on  both  sides  of  the  mount  and  in 
the  middle  through  a  tongue  formed  via  3D  modeling  into  the  arm.  Grooves  were  created 
on  the  inside  portion  of  the  post  and  both  sides  of  the  tongue  to  provide  a  base  for  springs 
to  rest,  and  therefore  not  slip  and  rub  against  the  pin  during  the  experiment.  It  should  be 
noted;  rubbing  of  the  spring  against  the  pin  could  not  be  avoided  since  in  compression, 
the  spring  will  want  to  naturally  bend.  With  this  said,  the  bending  is  far  less  then  what  is 
allowed  for  in  concept  A  and  should  help  to  achieve  a  more  linear  response. 
Figures  28-31  illustrate  the  prototype  of  the  improved  setup. 


Figure  28.  Concept  B — Side  View 
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Figure  29.  Concept  B — Top  View 


Figure  30.  Concept  B — Forward-Looking  View 
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Figure  3 1 .  Concept  B — Pin/Spring  Arrangement  Close-up 


One  key  factor  in  the  design  of  the  tongue  (see  Figure  31)  was  to  provide  enough 
fore/aft  room  for  the  arm  to  displace  under  excitation  and  not  hit  the  pin.  To  ensure  this,  a 
MATLAB  script  of  basic  trigonometry  was  coded  to  design  the  proper  dimensions  of  the 
tongue  hole.  In  this  code,  the  goal  is  to  ensure  the  hole  is  large  enough  so  the  outside 
edge  of  the  tongue  does  not  hit  the  pin  when  the  arm  is  maximally  displaced.  The  wider 
the  tongue,  the  better  chance  that  the  tongue  would  impact  the  pin;  therefore,  the  tongue 
was  designed  to  be  1 .27  cm  in  width.  If  the  tongue  were  any  thinner  there  was  concern 
that  the  stresses  from  the  spring  compression  may  break  the  tongue  or  at  best,  bend  it. 
The  other  piece  of  the  design  in  considering  hole  size  is  the  pin  size.  The  pin  diameter 
was  chosen  to  be  0.64  cm  based  on  the  size  of  the  height  of  the  tongue  coupled  with 
spring’s  size  that  could  fit  well  and  provide  an  appropriate  response.  Considering  this,  the 
smaller  the  hole,  the  less  allowance  for  displacement.  Table  4  illustrates  the  point.  The 
fore/aft  displacement  must  be  less  than  the  hole  diameter  minus  the  pin  diameter.  In 
Table  4  this  value  is  shown  as  the  margin  available  for  each  hole  diameter.  The  red 
values  indicate  when  the  end  displacement  will  cause  the  margin  for  a  particular  hole 
diameter  and  the  pin  will  be  exceeded. 
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Table  4.  Total  Displacement  of  Clearance  Hole  (cm)  for  Concept  B 


Varying  Hole  Diameter 

0.76 

cm 

1.012 

cm 

1.27 

cm 

1.52 

cm 

1.78 

cm 

2.03 

cm 

Margin 

0.064 

0.19 

0.32 

0.45 

0.57 

0.70 

End  Displacement 

2.54  cm 

0.046 

0.046 

0.048 

0.048 

0.048 

0.048 

5.08  cm 

0.130 

0.137 

0.140 

0.142 

0.145 

0.150 

7.62  cm 

0.267 

0.274 

0.279 

0.287 

0.292 

0.30 

10.2  cm 

0.442 

0.455 

0.465 

0.478 

0.488 

0.50 

12.70  cm 

0.660 

0.678 

0.696 

0.716 

0.732 

0.752 

15.24  cm 

0.922 

0.947 

0.975 

1.001 

1.026 

1.054 

The  shadowing  in  Table  4  illustrates  for  the  end  of  the  link  to  displace  at  least 
10.2  cm  (which  equates  to  approximately  19  degrees)  the  hole  diameter  would  need  to  be 
at  least  1.78  cm  in  diameter  (refer  to  the  shaded  row  and  column  of  Table  5).  Considering 
the  tongue  was  designed  to  be  2.54  cm  in  height,  this  was  detennined  to  be  too  large  of  a 
hole  due  to  the  strength  of  the  material  being  used.  That  is,  considering  the  amount  of 
force  the  spring  exerts  on  the  tongue,  by  removing  more  material  to  create  a  bigger  hole 
reduces  the  tongues  ability  to  not  bend  or  break  during  an  experiment.  In  the  end,  the  hole 
in  the  tongue  was  sized  to  be  rectangular;  0.762  cm  in  height  to  accommodate  the  0.635 
cm  pin  diameter  and  2.54  cm  wide  to  allow  for  travel  of  the  tongue  without  chance  of 
interference  with  the  pin.  Table  5  lists  the  springs  that  were  utilized  for  experimentation 
with  the  concept  B  prototype. 


Table  5.  Springs  Considered  for  Concept  B 


Length  (cm) 

Outside  diameter  (cm) 

Wire  diameter  (cm) 

Spring  rate  (kg/m) 

3.175 

0.762 

0.0813 

154.0 

3.175 

1.156 

0.991 

146.8 

3.175 

0.914 

0.104 

248.8 
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As  in  concept  A,  to  get  a  sense  of  the  response  of  the  spring  rates  noted  in  Table 
6,  the  torsional  mass  spring  system  parameters  of  inertia  and  torque  were  replaced  with 
mass  and  force,  respectively,  to  account  for  the  fact  that  extension  springs  are  used. 
Figure  32  illustrates  the  response  for  a  spring  rate  of  154.0  kg/m  with  a  maximum 
deflection  of  just  under  0.3  cm,  which  is  less  than  a  degree  of  deflection  for  the  33  cm 
vibrating  arm.  As  in  concept  A,  the  displacement  in  Figure  32  corresponded  visually  to 
initial  experimentation.  Therefore,  to  use  this  design  concept  much  lighter  springs  would 
need  to  be  used. 


Figure  32.  Displacement  Modeling  of  Concept  B  Model  with  a  Spring  Rate  of 

154.0  kg/m 

Again,  the  displacement  from  the  model  was  far  from  the  desired  deflection  of  19 
degrees,  but  as  will  be  seen  in  the  next  chapter,  the  motion  induced  on  this  link  on  the 
laboratory  test-bed  is  sufficient  to  provide  an  understanding  of  the  dynamics  and 
vibration  effects  associated  with  spacecraft  robot  arm  slews. 
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F. 


CONCEPT  C— MACHINED  TORSION  SPRING 


The  concept  of  using  a  machined  spring  for  the  flexible  joint  was  inspired  by  the 
website  of  Helical  Products  Co.  based  out  of  Santa  Maria,  California  [16].  Helical 
specializes  in  engineering  helical  machined  springs  to  produce  desired  amounts  of  torque 
and  flexion.  An  advantage  is  that  attachment  points  are  (can  be)  integrated  into  the  spring 
for  mounting.  These  attachment  points  allow  for  simple  assembly  of  the  torsion  spring 
joints  by  allowing  one  end  to  be  fixed  while  the  other  end  is  mounted  to  a  bearing  or 
some  device  that  allows  the  spring  to  be  torqued.  This  concept  enables  a  pure  moment 
and  linear  rates  to  be  transmitted  to  the  vibrating  ann.  As  such,  this  concept  may  prove  to 
be  the  best  option  for  a  lab  demonstrator.  Figure  33  shows  an  example  of  the  Helical 
product. 


Figure  33.  Example  of  a  Helical  Machined  Spring.  Source:  [16],  [17]. 

The  full  construction  of  concept  C  was  delayed  due  to  spring  manufacturing  lead- 
time  and  logistics;  therefore,  experimentation  using  this  concept  was  delayed  as  well. 
With  that  said,  initial  parts  for  the  concept  C  joint  were  created  using  the  3D  printer  and 
the  prototype  can  be  seen  in  Figures  34-36.  Figure  37  illustrates  the  assembled  design  as 
created  in  the  computer  aided  drawing  program,  Nx. 
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Figure  34.  Concept  C — Side  View 


Figure  35.  Concept  C — Top  View 
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Figure  36.  Concept  C — Bearing  Insert 


Figure  37.  Concept  C — Nx  Model  Front  View  of  Link  Mount  with  Simple  Model 

of  Machined  Spring  Inserted  at  the  Joint 


51 


The  parameters  in  Table  6  were  provided  to  Helical  engineers  to  provide  a  base 
estimate  for  performance  capabilities  and  cost. 


Table  6.  Concept  C  Torsion  Spring  Requirements 


Moment  ami 

30  cm 

Total  torque  applied  to  two-link  arm 

11.2  Nm 

Mass  of  one-link  arm 

11kg 

Deflection  required 

+/-10  cm 

Spring  Length 

5.08  cm 

Outside  diameter 

3.56  cm 

When  the  design  materialized,  the  torsional  spring  rate  provided  from  Helical  was 
3.39  deg/Nm.  The  spring  rate  simply  was  derived  by  dividing  the  required  deflection,  in 
degrees,  divided  by  the  torque  applied  from  one  Dynamixel  actuator.  Figures  38  and  39 
show  a  side  and  top  view  of  the  finished  helical  machined  spring. 


Figure  38.  Side  View  of  Helical  Machined  Spring  Manufactured  for  Test  Bed 
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Figure  39.  Top  View  of  Helical  Machined  Spring  Manufactured  for  Test  Bed 

When  the  spring  arrived,  it  was  apparent  from  handling  it  that  it  was  too  stiff  to 
produce  the  desired  deflection.  The  spring  was  assembled  in  the  mount,  but  as  expected, 
the  amount  of  torque  to  produce  any  deflection,  let  alone  the  desired  deflection,  was  not 
obtainable  from  the  system.  Unfortunately,  the  torsional  spring  rate  determined  from  the 
simple  modeling  did  not  accurately  represent  the  experimental  system.  The  test  bed  is  a 
complex,  multi-body  dynamical  system.  It  is  believed  that  the  main  error  in  the  modeling 
was  not  accounting  for  the  mass  of  the  base  plate.  The  base  plate  and  components  have  a 
mass  of  approximately  3 1  kg  compared  to  just  4.6  kg  for  the  robot  arm  and  2.3  kg  for  the 
vibrating  arm.  In  reality,  the  relatively  small  forcing  function  from  the  robot  arm  was 
simply  not  sufficient  to  overcome  the  significant  plate  inertia  and  induce  the  amount  of 
deflection  desired. 

The  spring  was  therefore  taken  to  the  NPS  machine  shop.  The  machinist  was  able 
to  remove  material  from  the  outer  diameter  to  create  a  “neck”  in  the  spring.  Figure  40 
shows  a  before  and  after  comparison  of  the  machined  spring.  The  fully  assembled 
concept  C  prototype  is  shown  in  Figure  41 . 
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Figure  40.  Comparison  of  Helical  Machined  Spring  before  and  after 

Material  Removed 


Figure  41.  Concept  C — Fully  Assembled 
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When  assembled  the  machined  spring  allows  for  deflection  of  approximately  +/- 
10  degrees.  This  result  proves  to  be  more  than  sufficient  to  visually  appreciate  the 
deflection  of  the  vibrating  ann  as  compared  to  concepts  A  and  B.  As  well,  since  the 
machined  spring  now  produces  this  larger  deflection  coupled  with  the  pure  moment  and 
linear  rates  from  a  machined  spring,  there  is  confidence  that  concept  C  is  the  preferred 
choice  for  future  experimentation. 

G.  SUMMARY 

The  main  purpose  of  this  chapter  was  to  document  the  development  of  various 
concepts  for  realizing  a  flexible  joint  that  could  be  used  in  experimentation  of  flexible 
space  systems  development  for  not  just  this  but  for  many  future  theses.  The  development 
of  each  concept  proved  to  lay  the  ground  for  the  experimentation  process  and  data 
analysis  moving  forward. 

Concept  A  was  a  simple,  initial  prototype  to  conduct  initial  experiments  of  the 
system.  Concept  was  a  more  elegant  design  that  allowed  for  different  spring  rates  to  be 
tested  easily.  However,  neither  of  these  concepts  produced  the  desired  deflection  of  19 
deg.  Concept  C  incorporated  a  helical  machined  spring  that  was  benefited  with  pure 
moments  and  linear  rates.  The  helical  spring  proved  to  be  the  best  of  the  three  concepts  to 
produce  the  desired  deflection  for  future  test  bed  experimentation. 
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IV.  SENSOR  INTERFACING  AND  DATA  PROCESSING 


In  this  chapter,  the  sensors  and  embedded  computer  implemented  on  the 
laboratory  test  bed  are  introduced  in  detail.  Additionally,  the  post-processing  procedures 
that  were  developed  during  the  course  of  the  thesis  will  be  described  including  the 
difficulties  encountered  and  the  methods  that  were  derived  to  mitigate  these  challenges 
and  ultimately  provide  the  most  efficient  and  accurate  means  of  analyzing  the  data  after 
experimentation. 

A.  INERTIAL  MEASUREMENT  UNIT 

In  order  to  analyze  the  excitation  imparted  on  the  vibrating  arm  with  the  flexible 
joint,  the  robotic  arm,  and  the  plate,  an  inertial  measurement  unit  (IMU)  was  mounted  at 
the  end,  side  face  of  each  arm  and  near  the  outer  edge  of  the  plate,  respectively.  The  IMU 
used  is  the  nine-degree  of  freedom  (9DOF)  Razor  Inertial  Measurement  Unit  developed 
by  the  company  “Sparkfun”  [18].  In  addition  to  an  accelerometer  in  all  three  axes,  the 
Razor  has  a  magnetometer  and  gyroscope  for  each  axis.  The  accelerometer  in  the  Razor, 
the  ADXL345  [19]  is  capable  of  sensing  accelerations  up  to  a  maximum  of  10,000  gs,  far 
more  than  the  accelerations  to  be  observed  in  this  test  laboratory.  The  ITG-3200A 
gyroscope  has  a  full-scale  range  of  +/-2000  °/sec  [20].  The  Razor  is  shown  in  Figure  42. 
Figure  43  illustrates  where  each  IMU  is  located  in  the  final  test  bed  configuration. 
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Figure  42.  9D0F  Razor  IMU.  Source  [18]. 


Figure  43.  IMU  Placement  for  Final  Test  Bed  Configuration 
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B.  CALIBRATION 

Before  the  IMUs  can  be  attached  to  their  respective  positions,  each  accelerometer 
and  gyroscope  must  be  calibrated.  Sensor  calibration  is  required  to  account  for  minor 
defects  in  the  sensor  due  to  manufacturing,  assembly,  etc.  An  IMU  that  is  not  calibrated 
can  affect  precision  and  responsiveness  of  the  IMU  such  as  drift  in  yaw  when  roll  is 
applied  to  the  board  [18].  The  calibration  factors  that  are  determined  through  the 
calibration  process  help  to  alleviate  these  minor  defects  that  are  particular  to  each  IMU. 

The  procedures  are  detailed  in  a  tutorial  linked  via  the  Sparkfun  website  [18].  To 
perform  the  calibration,  each  IMU  was  connected  to  an  FTDI  breakout  board  and  then  to 
the  user’s  laptop  via  a  USB  cable.  The  FTDI  breakout  board  receives  the  raw  data  from 
each  sensor  and  routes  that  data  through  an  embedded  integrated  circuit  (IC).  Now  that 
the  data  is  packaged  neatly  on  the  IC,  the  serial  data  is  transferred  to  the  host  computer 
via  a  USB  cable  [21].  The  program  Arduino  [22]  was  used  to  read  the  data  off  of  the 
IMU  as  well  as  to  perform  the  calibration.  The  process  to  calibrate  the  accelerometers 
was  the  most  difficult  and  time  consuming.  The  basic  procedure  was  to  find  the 
maximum  and  minimum  readings  for  each  axis  in  a  static  test.  The  maximum  /  minimum 
values  corresponded  to  a  gravity  measurement  of  lg.  To  perform  the  calibration,  the  user 
held  the  IMU  steady  to  begin  the  process  and  then  slowly  rotated  the  IMU  to  find  the 
maximum  and  minimum  values.  Moving  the  IMU  slowly  so  as  to  not  induce  excess 
accelerations  was  the  difficult  part.  With  this  in  mind,  the  process  was  performed  three 
times  to  find  an  average  maximum  and  minimum  value  for  each  axis.  Figure  44 
illustrates  the  captured  sensor  output  during  the  acceleration  calibration. 
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Figure  44.  Example  Data  for  Accelerometer  Calibration.  Source:  [22]. 
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The  average  values  were  then  entered  into  the  Arduino  code  by  replacing  the 
baseline  values  of  +/- 256  LSB.  Figure  45  shows  the  location  in  the  Arduino  interface 
where  the  user  enters  the  accelerometer  calibration  data.  In  Figure  45  the  baseline 
accelerometer  values  are  shown;  that  is  +/-  256  LSB. 
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j  Razor_AHR5  § 

Compass  DCM 

. 1 

Math 

Output 

Sensors 

'W 

//  It  is  not  necessary  to  set  this!  It  just  makes  life  easier  when  writing  cod 
//  the  receiving  side.  The  Processing  test  sketch  also  works  without  setting  t 
//  NOTE:  When  using  this,  OUTPUT_STARTUP_STREAM_ON  has  no  effect! 

#define  OUTPUT _ HAS_RN_BLUETOOTH  false  //  true  or  false 


//  SENSOR  CALIBRATION 

//  How  to  calibrate?  Read  the  tutorial  at  httn: //dev.an.tu-bprl i n.de/nroierts/ 
//  Put  MIN/MAX  and  OFFSET  readings  for  your  board  here! 

//  Accelerometer 

//  "accel  x,y,z  (min/max)  =  X_MIN/X_MAX  Y_MIN/Y_MAX  Z_MIN/Z_MAX" 

#define  ACCEL_X_MIN  ((float)  -256) 

#define  ACCEL_X_MAX  ((float)  256) 

#define  ACCEL_Y_MIN  ((float)  -256) 

#define  ACCEL_Y_MAX  ((float)  256) 

#define  ACCEL_Z_MIN  ((float)  -256) 

#define  ACCEL_Z_MAX  @(float)  256) 

c  ..  j  D 

2 


221  Arduino  Pro  or  Pro  Mini,  ATmega328  (3.3V,  8  MHz)  on  /dev/cu.usbserial-A40083NG 


Figure  45.  Coding  the  Accelerometer  Arduino  Interface.  Source:  [22]. 
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Figure  46  illustrates  how  the  calibration  is  changed  in  the  code.  Note  the  changes 
to  each  axes’  minimum  and  maximum  values. 


Razor  AHR5 
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Output 

Sensors 

//  the  receiving  side.  The  Processing  test  sketch  also  works  without  setting  t 
//  NOTE:  When  using  this,  OUTPUT__STARTUP_STREAM_ON  has  no  effect! 

#define  OUTPUT _ HAS_RN_BLUETOOTH  false  //  true  or  false 


//  SENSOR  CALIBRATION 

/*****************************************************************/ 

//  How  to  calibrate?  Read  the  tutorial  at  http://dev.au. tu-berlin.de/nroiects/ 
//  Put  MIN/MAX  and  OFFSET  readings  for  your  board  here! 

//  Accelerometer 

//  "accel  x,y,z  (min/max)  =  X_MIN/X_MAX  Y_MIN/Y_MAX  Z_MIN/Z_MAX" 

#define  ACCEL_X_MIN  ((float)  -289) 

#define  ACCEL_X_MAX  C(float)  238) 

#define  ACCEL_Y_MIN  ((float)  -272) 

#define  ACCEL_Y_MAX  ((float)  260) 

#define  ACCEL_Z_MIN  ((float)  -271) 

#define  ACCEL_Z_MAX  ((float)  252) 


o 


Arduino  Pro  or  Pro  Mini,  ATmega328  (3.3V,  8  MHz)  on  /dev/cu.usbserial-A40083NG 


Figure  46.  Coding  the  Accelerometer  Calibration  Factors.  Source:  [22]. 


After  the  accelerometer,  the  magnetometer  is  calibrated.  To  begin,  the  direction  to 
North  is  determined.  The  x-axis  of  the  IMU  is  pointed  to  North  and  then  rotated  about  the 
East-West  direction.  Similar  to  calibrating  the  accelerometer,  the  IMU  is  then  tilted  in 
every  direction  until  a  maximum  value  is  obtained,  then  the  IMU  is  pointed  in  the 
opposite  direction,  and  the  IMU  is  titled  to  now  find  the  minimum  values.  A  similar 
process  is  performed  for  the  y  and  z-axes.  Each  axes  values  are  recorded  and  entered  into 
the  Arduino  calibration  code  in  place  of  the  baseline  values  of  600  LSB. 

After  the  magnetometer,  the  gyroscope  is  calibrated.  This  process  is  much 
simpler.  The  gyroscope  is  simply  held  steady  for  a  minimum  of  ten  seconds  or  until  the 
values  in  each  axis  are  steady.  The  steady  values  represent  the  gyroscope  drift  rate.  Once 
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steady,  the  outputs  are  noted  and  entered  in  the  Arduino  code  in  place  of  gyroscope 
baseline  values  of  0.0  LSB.  The  gyroscopic  data  is  in  units  of  LSB.  Tables  7,  8,  and  9 
show  the  average  calibration  results. 


Table  7.  Accelerometer  Calibration  Data 


X  (LSB) 

Y  (LSB) 

Z  (LSB) 

Plate  (min/max) 

-289/238 

-272  /  260 

-271  /252 

Vibrating  Ann 
(min/max) 

-269  /  266 

-270  /  293 

-282  /  246 

Robot  Arm 
(min/max) 

-272  /  254 

-254/265 

-298/238 

Table  8.  Magnetometer  Calibration  Data 


X  (LSB) 

Y  (LSB) 

Z  (LSB) 

Plate  (min/max) 

-381  /427 

-571  /394 

-326  /  460 

Vibrating  Ann 
(min/max) 

-399/459 

-509/461 

-295  /  602 

Robot  Arm 
(min/max) 

-392/512 

-439  /  422 

-495  /  466 

Table  9.  Gyroscope  Calibration  Data 


X  (LSB) 

Y  (LSB) 

Z  (LSB) 

Plate 

0.21 

24.66 

33.13 

Vibrating  Ann 

-8.37 

57.62 

23.03 

Robot  Arm 

-2.61 

38.56 

11.16 

The  sensitivities  for  each  sensor,  accelerometer,  gyroscope,  and  magnetometer, 
were  obtained  from  the  respective  data  sheets.  The  accelerometer,  gyroscope,  and 
magnetometer  data  is  given  in  LSBs.  The  data  is  then  divided  by  the  sensitivity  factor  for 
each  sensor.  Table  10  shows  those  factors. 
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Table  10.  IMU  Sensitivity  Factors 


Sensor  Sensitivity  Factor 

Converted  Units  for  Post- 
Processing 

Accelerometer  [23] 

256  +/-  30  (LSB/g) 

Gravity 

Gyroscope  [20] 

14.375  LSB/°/sec 

°/sec 

Magnetometer  [24] 

230  -  1370  LSB/gauss 

Gauss 

The  magnetometer  sensitivity  factor  is  given  for  completeness.  Ultimately  the 
magnetometer  was  not  used  in  the  post-processing  analysis,  but  was  used  only  for  the 
calibration  process  and  to  aid  in  evaluating  the  accuracy  of  the  yaw,  pitch,  and  roll 
measurements  discussed  in  Chapter  IV. 

The  IMUs  were  then  attached  to  the  system  in  their  respective  locations.  A  static 
test  was  the  conducted  to  observe  the  accelerations  along  the  tangential  axis  at  the  end  of 
the  arm  and  the  outer  edge  of  the  plate.  The  vertical  and  nonnal  axes  were  ignored  since 
the  primary  motion  of  concern  was  in  the  horizontal  plane,  which  is,  vibrating  motion. 
With  this  said,  when  the  static  tests  were  perfonned,  it  was  expected  that,  after  the 
calibration,  the  tangential  axis  accelerations  would  be  near  zero.  If  the  values  were  not 
near  zero,  small  refinements  to  the  average  calibrated  values  were  entered  until  the  static 
accelerations  were  observed  as  near  zero.  Even  after  this  was  completed,  noise  in  the 
sensor  was  observed  so  as  in  a  static  condition  the  accelerations  fluctuated  +/-  2.0  LSB. 
When  divided  by  256  LSB/gravity,  this  gives  a  small  fraction  of  gravity  (0.0078  gs) 
imparted  as  the  noise.  What  will  be  shown  in  the  experiment  results  in  Chapter  V  is  that 
the  noise  was  more  apparent  in  concepts  A  and  B  due  to  their  relatively  small  vibrating 
displacement  compared  to  concept  C. 

After  the  calibration  is  complete,  the  user  configures  the  Arduino  output  code  so 
the  displayed  values  only  reflect  what  the  user  requires.  Figure  47  illustrates  the  output 
code  tab  of  Arduino.  For  example,  if  the  Arduino  output  code  were  not  changed,  the  yaw, 
pitch,  roll  angles  and  accelerations  in  all  axes  would  be  displayed.  As  will  be  discussed 
later  in  section  E,  the  post-processing  for  concepts  A  and  B  were  completed  with  the 
user’s  laptop  computer  whereas  concept  C  incorporated  a  more  robust  system  design 

incorporating  the  National  Instruments  cRIO  9024  embedded  computer  [25],  discussed  in 
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section  D  of  this  chapter.  With  that  said  tangential  accelerations  were  only  analyzed  in 
concepts  A  and  B  for  system  initial  development,  and  tangential  and  normal  accelerations 
as  well  as  gyroscopic  data  was  captured  for  concept  C.  In  Figure  47  the  script  colored 
orange  represents  the  serial  data  that  will  be  displayed.  In  this  case  all  three  axes  of 
acceleration  and  all  three  axes  of  gyroscopic  data  are  displayed. 


//  Output  orgies:  you  pitch,  roll 

vj'.t!  outp--t_onglesO 
{ 

if  (output_format  --  OUTPUT _ FOfiMAT.BINART) 

{ 

float  >pr[3]; 
ypr[0]  ■  TO.CEGCycw); 
ypr[l]  «  TO.CCGCpitch); 
ypr[2]  -  T0_C€G(roll); 

Seriol.*rite((byte*)  ypr,  12);  //  No  rw*-line 

} 

else  if  (output_format  OUTPUT _ FOfiXAT_TEXT) 

{//Serial. printC’SYPK- 

//Serial .pnntCTO.DEGCycw));  Serial .printC"  ”); 
//Seriol.prmtCTO.DEGCpitch));  Serial .pnnt("  "); 
//Seriol  .printCTO.DEGCroll));  Serial  .printlnQ; 

//  Seriol.printCTO-OEGCroll));  Serial .printC"  H); 


Serial .print(accel[0]);  Serial .pnnt('  ”); 
Senal.print(accel[l]);  Serial.printC  "); 
Serial. printCaccel[2J);  Serial .printC"  "); 

Seriol  prmt(gyro[0]);  Serial.printC"  "); 
Serial .print(gyro[l]);  Serial .printC"  "); 
Serial  .prmt(gyro[2]);  Serial  .printC  “); 
Serial.printC^n*); 


User  defined 
output  block 


Figure  47.  Arduino  Output  Code.  Source:  [21]. 


C.  NATIONAL  INSTRUMENTS  CRIO  CONTROLLER 

In  order  to  build  a  test  bed  interface  that  could  monitor  and  control  several 
devices  at  once,  it  was  decided  to  incorporate  an  embedded  computer  onto  the  center  of 
the  plate  to  act  as  a  central  hub  of  information  control.  The  device  chosen  to  perform  this 
task  was  the  National  Instruments  cRIO  model  9024  [25].  This  model  is  a  real-time 
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controller  with  specifications  of  800  MHz,  512  MB  DRAM,  and  4  GB  of  storage.  It  is  a 
real  time  embedded  controller  that  runs  the  program  LabVIEW  “for  real-time 
detenninistic  control,  data  logging,  and  analysis”  [26].  Additionally,  the  chassis  that 
holds  the  cRIO  has  four  slots  for  serial  interface  modules.  Three  NI  9870  serial  interface 
modules  were  used.  Each  module  has  four  ports  that  connect  to  the  IMUs  via  an  RS232 
connector.  Additional  ports  allow  future  expansion  of  the  test  bed  to  incorporate  up  to  16 
serial  data  components.  Figures  48  and  49  illustrate  the  configuration  of  the  embedded 
system. 


Figure  48.  NI  CRIO  9024  Configuration 
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Figure  49.  NI  CRIO  9024  Close-up 

The  cRIO  allows  the  user  to  monitor  all  IMU  measurements  at  one  time  as  well  as 
providing  a  means  to  implement  the  optimal  control  trajectory  to  the  robotic  arm.  This  is 
a  great  advantage  since  the  Arduino  software  allows  the  user  to  monitor  just  one  IMU  at  a 
time.  Moreover,  the  Robotis  Dynamixel  Wizard  software  does  not  provide  a  means  to 
incorporate  time-tagged  control  trajectories.  In  order  to  achieve  this  embedded 
functionality,  the  built  in  program  LabVIEW  will  be  used.  LabVIEW  is  central  to 
National  Instruments  approach  to  engineering  and  science  applications.  LabVIEW  is  a 
development  environment  with  a  graphical  programming  syntax  to  visualize,  create,  and 
code  engineering  systems.  Additionally,  LabVIEW  is  designed  to  interoperate  with  other 
software  to  ensure  multiple  tools  are  available  to  the  user  from  a  central  platform  [26]. 

The  cRIO  and  IMUs  were  powered  by  a  separate  power  supply  providing  24 
VDC.  Power  was  routed  through  a  distribution  board  to  each  IMU  and  the  cRIO. 
Figure  50  illustrates  the  power  distribution  board.  The  two  DC-DC  converters  provide 
outputs  of  +  12VDC  and  +5VDC  to  power  the  various  devices. 
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Figure  50.  Power  Distribution  Board 


Additionally,  an  Ethernet  cable  is  connected  from  the  cRIO  to  the  host  computer 
for  monitoring  and  post-processing.  Subsequent  theses  in  support  of  this  project  will 
incorporate  a  housing  for  a  24  VDC  battery  as  well  as  components  to  communicate 
wirelessly  with  the  host  computer.  This  will  enable  the  test  bed  to  be  completely  free  of 
external  cables  and  wires;  therefore,  no  external  torques  from  hanging  cables  will  be 
applied  to  the  overall  system. 

1.  Lab  VIEW  IMU  Integration 

In  order  to  capture  and  display  IMU  output,  the  Lab  VIEW  program  was  used. 
Lab  VIEW  has  a  graphical  coding  environment  similar  to  Simulink.  A  download  from  the 
National  Instruments  website  support  page  was  used  to  provide  an  example  graphical 
block  set  that  could  be  used  to  stream  serial  data  [27].  Minor  changes  were  made  to  the 
code  in  order  to  write  the  data  from  each  IMU  to  a  text  file.  Figure  51  illustrates  the  code 
block  that  was  used  while  Figure  52  shows  the  front  panel  display  for  each  port  of  the 
serial  data  module.  For  this  test  rig,  three  ports  are  used,  one  for  each  IMU. 
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Write-to-text 

files  addition 

B1 - I - 


|l.  Cpena  referente  to  Die  FPGA  VI,  reset  its  vaiues,  and  Run  h  VI. 

2,  Bald  the  ray  as  reqjred  in  input  to  the  Pint  Confugjition  Sib  A 

3.  Read  iero  etafe  io®  the  RHD.HFO  todetenrine  ban  many  dements  are  there  and  rad  to  be  read  in  lie  tee  Start, 

4.  Read  al  of  the  elerrents  in  the  RBhD  FIFO,  as  determined  by  tfe  Read  in  Step  3. 

5,  Slit  the  hi  and  km  runbes  So*  tie  116  read  fro*  lie  FIFO,  The  hi  value  is  usd  to  tone  fan  which  port  tie  Wtrafa  ongfaied, 

7.  fege  RTard  TOS  errors  to  be  handled  n  RT, 


:  The  entire  prop®  set  to  reed  data  from  the 
rxnetrs  ws  obtained  as  an  example  hum  the 
el  Murads  /rebate  supportsectfan.  The  only 
tains  were  the  atitix  of  the  wife  to  text  fife  \Ts 
searte  after  the  pop®  is  stopped  tsaye  fe 
r meter  data  and  the  Snestamp  firnSkm  tc  raith 
data  fro®  the  aecelercreters, 


Figure  51.  Lab  VIEW  Continuous  Serial  Data  code  for  IMU  DATA.  Source:  [27]. 


Figure  52.  Lab  VIEW  Continuous  Serial  Data  Front  Panel  for  IMU  Data. 

Source:  [27]. 
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2.  Collecting  IMU  Measurements 

To  collect  and  view  the  data,  the  “run”  button  on  the  front  panel  is  clicked  and 
serial  data  begins  to  stream.  Once  the  experiment  has  completed,  “stop  program”  is 
selected,  and  the  first  of  three  windows  appear.  Each  window  saves  the  serial  data  from 
the  IMUs  into  separate  text  files  for  post-processing. 

3.  Lab  VIEW  Robotic  Arm  Model  Development 

The  utility  and  capability  of  Lab  VIEW  was  not  just  in  the  serial  data  processing, 
but  also  in  the  interface  with  robotic  actuators.  Code  to  read  and  display  commands  to  the 
actuators  was  found  in  a  National  Instruments  discussion  forum.  LabVIEW  has 
compatibility  with  the  Robotis  MX- 106  actuators.  The  LabVIEW  code  to  implement  the 
optimal  control  trajectory  to  the  robotic  actuators  was  created  with  the  assistance  of  the 
National  Instruments  discussion  forum  and  intern  assistance  [28].  These  actuators  are  not 
as  complex  as  the  M42-10-S260-R  actuators  of  the  robot  arm,  but  are  useful  in 
demonstrating  the  initial  process  and  capability  of  LabVIEW  to  implement  optimal 
control  paths.  Drivers  for  the  more  capable  M42-10-S260-R  actuators  are  needed  for  use 
in  the  LabVIEW  environment.  Not  having  the  drivers  restricted  the  ability  to  perform 
experimentation  with  these  actuators.  A  note  to  the  reader,  in  the  process  of  developing 
the  test  rig,  two  of  three  M42-10-S260-R  actuators  that  were  to  be  used  were  damaged 
and  therefore  were  not  able  to  be  used  for  experimentation.  The  actuator  that  was  not 
damaged  was  mounted  to  the  robot  ann  base  to  perfonn  the  experimentation  discussed  in 
Chapter  IV.  Due  to  the  hardware  issue  only  one  DOF  could  be  actuated  for  the  tests. 
Figure  53  illustrates  the  graphical  code  that  could  be  later  extended  to  drive  the  M42-10- 
S260-R  actuators. 
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Figure  53.  Robotic  Motor  Control  Lab  VIEW  Code.  Source:  [28]. 


D.  DATA  POST-PROCESSING  PROCEDURES 

1.  Beginning  Processes  for  Concepts  A  and  B 

To  read  the  data  from  the  sensors,  software  from  Arduino  was  used  to  program 
Razor’s  microprocessor.  The  Arduino  software  provides  a  means  to  read  accelerometer, 
magnetometer,  and  gyroscope  data  via  a  serial  monitor  [21].  Arduino  itself  does  not  have 
tools  to  plot  the  data  received  from  the  Razor.  There  is  a  means  to  view  serial  data 
graphically,  but  it  is  for  real-time  use  only  and  not  for  post-processing  needs.  The  user  is 
required  to  develop  a  means  to  read  the  serial  data  into  other  programs  such  as  MATLAB 
for  analysis.  Without  editing  the  Arduino  code,  the  serial  monitor  displays  yaw,  pitch  and 
roll  angles  calculated  from  the  nine  inputs  received  from  the  Razor.  In  order  to  capture 
the  data,  the  code  for  the  serial  monitor  display  was  edited  to  display  only  raw 
acceleration  measurements.  The  Arduino  user  interface  provides  a  relative  easy  means  to 
make  such  edits  as  discussed  earlier. 
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Once  the  serial  monitor  displayed  only  accelerations  for  each  axis,  further  edits 
were  made  such  that  only  the  axis  excited  by  the  movement  from  the  two-link  ann  would 
be  displayed.  With  the  serial  monitor  now  displaying  the  single,  excited  axis  values, 
experiments  could  be  conducted  with  the  goal  of  measuring  the  motion  induced  on  the 
flexible  link  due  to  movement  of  the  robot  arm.  For  the  initial  testing  of  each  concept,  the 
maximum  torque  possible,  5.6  Nm/actuator,  from  the  Dynamixel  M42-10-S260-R 
actuator  was  applied.  The  trajectory  of  the  two-link  arm  displaced  the  linkage 
approximately  160  degrees;  that  is,  the  movement  of  the  two-link  arm  was  displaced  from 
one  side  to  the  other  and  vice  versa.  Figure  54  shows  the  lab  test  bed  where  the  two-link 
electrically  actuated  arm  is  on  the  right  and  the  one-link  arm  with  flexible  joint  is  on 
the  left. 


Figure  54.  Lab  Test  Bed — Early  Stage  of  Completion 
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To  plot  the  data,  the  following  process  was  conducted.  First  the  serial  monitor 
displayed  the  data  as  discussed  previously.  With  this  said,  it  should  be  understood  by  the 
reader  that  the  serial  monitor  continuously  displays  data  from  the  Razor;  that  is,  once 
initialized,  the  Razor  will  continue  to  produce  data,  moving  or  not,  until  the  USB  is 
disconnected  from  the  test  bed  computer.  Therefore,  the  basic  method  to  capture  the  data 
was  to  send  a  command  to  the  two-link  arm  via  the  Robotis  software,  allow  the  flexible 
joint  arm  time  to  settle  and  then  disconnect  the  USB  from  FTDI  breakout  board.  From 
this  point,  the  serial  monitor  freezes.  The  data  displayed  on  the  serial  monitor  was  then 
copied  and  pasted  into  MATLAB  for  analysis. 

2.  Refined  Post-process  Development 

As  mentioned  previously,  there  was  an  accepted  delay  in  the  design  and 
manufacturing  of  the  machined  helical  spring.  Once  the  beginning  processes  proved  the 
test  bed’s  basic  functionality  worked;  that  is,  the  robotic  arm  imparted  a  torque  on  the 
opposite  flexible  joint  link  arm,  a  more  refined,  robust  procedure  was  developed  to  aid  in 
the  post-processing  procedures  for  concept  C,  but  more  importantly  to  construct  a  means 
to  evaluate  several  IMUs  at  once  as  well.  The  NI  cRIO  allows  the  user  to  do  this. 
Figure  55  shows  the  final  test  bed  construction. 


Figure  55.  Lab  Test  Bed — Final  Stage  of  Completion 
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The  main  limitation  of  the  cRIO  is  that  there  is  not  a  means  to  calibrate  the  IMUs 
nor  upload  the  Arduino  code  to  the  IMU  after  the  calibration  and  desired  data  for  display 
has  been  entered.  With  this  said,  similar  to  the  initial  process,  a  separate  laptop  was  used 
to  perfonn  this  step  of  the  process.  Once  the  Arduino  code  was  uploaded  to  each  IMU, 
they  were  then  secured  to  the  test  bed  and  connected  to  a  RS232  connector,  which  was 
then  connected  to  the  NI  cRIO. 

The  initial  measurement  techniques  focused  on  monitoring  the  tangential 
acceleration  of  the  vibrating  arm  to  gain  a  sense  of  the  system  performance.  However,  it 
was  detennined  that  the  analysis  also  required  additional  components  of  acceleration  and 
gyroscope  data  to  be  captured.  The  actual  angular  displacement  of  the  vibrating  arm  was 
desired  as  well  to  provide  a  visual  sense  of  the  experiments.  This  would  confirm  that, 
with  simple  time-series  integration,  the  acceleration  data  could  be  processed  to  produce 
the  angular  motion  that  was  being  observed.  Several  iterations  to  obtain  success  had  to  be 
performed. 

A  typical  experiment  would  be  conducted  by  commanding  the  robotic  arm 
through  some  trajectory.  This  imparts  a  torque  and  subsequent  motion  on  the  free- 
floating  plate  in  the  opposite  direction  of  the  robotic  arm  movement.  This  causes  the 
vibrating  ann  to  initially  displace  in  the  opposite  direction  of  the  plate.  As  the  arm 
vibrates,  its  motion  imparts  subsequent  torques  on  the  plate  until  the  motion  is  completely 
damped. 

Initially,  it  was  thought  that  the  tangential  acceleration  could  be  sensed  at  the  end 
of  the  vibrating  arm  and  then  mapped  to  the  angular  motion  of  the  flexible  joint  by  the 
rotational  mechanics  (4.1)  and  (4.2). 


at  =  a*  r 

(4.1) 

a  =  at  /  r 

(4.2) 

where  a  is  in  units  of  rads/sec2.  Then  if  the  plate  tangential  accelerometer  could  be 
mapped  to  the  center  of  the  plate  in  a  similar  manner,  the  plate  angular  acceleration  could 
be  subtracted  from  the  vibrating  arm  angular  acceleration  and  then  double  integrated  to 
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give  the  position  angle  of  the  flexible  appendage.  As  it  turns  out,  simply  double 
integrating  acceleration  to  obtain  position  produces  invalid  results  due  ignorance  of  the 
velocity  and  position  initial  conditions  [28]. 

Figure  56  illustrates  the  erroneous  results  obtained  from  initial  testing  of  concept 
C.  The  figure  shows  a  comparison  of  integrated  accelerations  obtained  by  a  numerical 
integration  code  written  in  Excel  to  MATLAB’s  cumtrapz  [29]. 


Experimentally  Derived  Velocity  Analysis  - 


Experimentally  Derived  Position  Analysis  - 


Figure  56.  Experimental  Data  Analyzed  by  Double  Integrating  Raw 

Accelerometer  Data 


At  first  glance,  the  results  of  Figure  56  appear  to  make  sense.  When  the 
experiment  is  conducted,  the  motion  of  the  robot  arm  causes  the  plate  to  freely  rotate 
while  the  flexible  joint  arm  is  vibrating.  When  the  flexible  joint  arm  stops  vibrating,  the 
plate  continues  to  drift  as  is  observed  in  Figure  56.  However,  the  fact  that  velocity  was 
“drifting”  as  well,  that  is  increasing  in  this  case,  didn’t  make  sense.  To  investigate  this 
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“drift”  phenomenon,  a  simple  sine  wave  was  double  integrated  via  a  Simulink  model. 
Figure  57  depicts  the  model  used. 


To  Workspace2 


Figure  57.  Simulink  Model  of  a  Double  Integrator  System 

Figure  58  illustrates  the  results  of  the  Simulink  simulation  assuming  zero-initial 
conditions  on  velocity  and  position. 


Position 


Time  (sec) 


Figure  58.  Double  Integrating  a  Sine  Wave  without  Accounting  for 

Initial  Conditions 
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Though  velocity  has  the  same  sinusoidal  shape  of  the  acceleration  plot,  notice  that 
its  amplitude  has  shifted  up  introducing  a  drift  error.  The  position  plot  in  Figure  58  is  the 
most  apparent  that  something  is  wrong.  Calculus  tells  us  that  the  resultant  plot  should 
return  a  sinusoidal  result  as  seen  in  the  acceleration  curve.  Yet,  the  position  drifts  as  seen 
in  Figure  58.  The  same  simple  sine  function  was  double  integrated  via  numerical 
integration  methods,  a  user  created  algorithm  and  MATLAB’s  cumtrapz  function  as  a 
check  on  the  Simulink  results.  Both  simulations  produced  the  same  results  as  in 
Figure  58. 

It  turns  out  that  this  phenomenon  is  more  common  then  realized  and  is  discussed 
in  detail  in  [30].  The  problem  is  that  when  integrating  acceleration  data  twice  to  produce 
position  data,  the  exact  initial  conditions  to  derive  the  position  from  velocity  are 
unknown.  With  time-series  data,  one  does  not  know  how  much  to  shift  the  data  or  at  what 
time-series  data  point  to  accurately  account  for  the  initial  conditions  of  the  second 
integration  which  leads  to  position  detennination.  The  resulting  position  plot  provides 
erroneous  data. 

To  verify  the  above  arguments,  another  simulation  was  performed.  In  a  Simulink 
model,  the  user  can  input  the  initial  conditions  as  desired  resulting  in  expected  plots 
where  velocity  is  out  of  phase  with  acceleration  and  furthermore  position  is  out  of  phase 
with  velocity,  provided,  as  in  Figure  59,  that  the  correct  initial  conditions  are  selected. 
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Acceleration 


Figure  59.  Double  Integrating  Sine  Wave  with  Correct  Initial  Conditions 


To  overcome  this  challenge,  it  was  detennined  that  the  gyroscopic  data  could 
additionally  be  used.  The  method  that  was  finally  settled  on  to  accurately  represent  the 
motion  of  the  system  was  to  first  differentiate  the  gyroscope  data  to  compute  the  angular 
acceleration.  This  operation  in  MATLAB  is  performed  as: 

acceleration  data  —  dl^^9yro  datai 

diff(time ) 

Once  each  angular  acceleration  was  obtained,  the  data  was  numerically  integrated 
with  cumtrapz  to  obtain  angular  rate,  and  then  once  more  to  obtain  angular  position  data. 

1.  rate  —  cumtrapz  (acceleration) 

2.  position  —  cumtrapz  (rate) 

The  results  of  this  process  as  applied  to  concept  C  are  discussed  in  Chapter  V. 
Frankly  it  is  a  peculiar  outcome  considering  previous  numerical  methods  gave  erroneous 
results;  however,  the  process  above  does  produce  the  observed  results.  The  explanation  is 
that  differentiating  the  gyro  data  to  obtain  an  angular  acceleration  and  then  integrating  to 
arrive  back  at  angular  rate  allows  drift  to  be  corrected  because  of  the  mismatch  between 
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finite  differentiating  and  the  trapezoidal  rule  for  integration.  To  attempt  to  recreate  this 
phenomenon  manually,  the  vibrating  ann  acceleration  data  was  numerically  integrated  to 
arrive  at  the  plot  in  Figure  60. 


Vibrating  Arm  Angular  Rate  - 


Figure  60.  Vibrating  Arm  Angular  Rate  by  Numerically  Integrating 

Acceleration  Data 

Taking  the  initial  and  final  y-axis  values  of  the  data  in  Figure  60  created  the  slope 
of  the  line.  Figure  61  shows  the  slope  transposed  onto  the  plot  in  Figure  60. 
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Vibrating  Arm  Angular  Rate  with  Slope  - 


Time  (sec) 


Figure  61.  Vibrating  Arm  Angular  Rate  with  Slope  Overlay 

The  slope  array  was  added  to  the  vibrating  arm  angular  rate  data.  This  addition  is 
the  manual  approach  to  removing  the  slope  bias  error  incurred  from  the  initial  cumtrapz 
numerical  integration.  However,  the  problem  is  that  the  final  value  of  the  vibrating  arm 
angular  rate  is  accurate  in  MATLAB  to  four  significant  digits.  To  form  a  data  series  for 
the  slope  with  its  length  equal  to  the  time  array,  the  time  steps  between  each  data  point 
will  have  a  small  error  of  accuracy.  Therefore,  the  slope  data  series  end  point  will  have  a 
slightly  different  value  than  the  original  data’s  end  point. 

vib  arm  data  corrected  —  vib  arm  data  +  slope 

Figure  62  shows  the  results  of  the  vibrating  arm  angular  rate  data  compared  to  the 
process  eventually  used  in  the  final  experiment.  One  can  see  that  the  plot  adjusted  for 
slope  is  not  smooth  due  to  the  error  present  in  computing  and  then  adding  the  slope 
adjustment. 
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Vibrating  Arm  Angular  Rate  Adjusted  for  Slope 
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Figure  62.  Vibrating  Arm  Angular  Rate  Adjusted  for  Slope  Compared  to  Method 

of  Determining  Rate  from  Differentiating  Gyro 

With  the  plot  corrected  for  the  slope  bias,  the  data  was  numerically  integrated 
again  with  cumtrapz  to  arrive  at  the  vibrating  arm  position  data. 

vib  postion  —  cumtrapz(yib  arm  data  corrected ) 

Figure  63  shows  the  results  of  the  slope  adjustment  compared  to  the  method  that 
was  ultimately  used  in  the  final  experimental  process.  The  small  amount  of  error  in  the 
rate  data  contributes  to  the  inaccuracies  of  the  position  data.  While  the  results  of 
manually  accounting  for  the  bias  do  not  produce  results  as  accurate  as  the  real-world 
motion  of  the  test  bed  compared  to  differentiating  the  gyro  data,  the  plot  is  comparable 
and  certainly  better  than  not  accounting  for  slope  or  initial  conditions.  This  result  also 
confirms  the  notion  that  by  differentiating  and  then  integrating  the  gyroscope  data  the 
bias  slope  is  effectively  canceled  out.  Additionally,  the  lower  plot  of  Figure  63  adds  a 
comparison  of  the  increased  error  propagated  through  when  simply  double  integrating  the 
acceleration  data  and  not  accounting  for  the  slope  or  initial  conditions. 
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Position  of  Arm  with  Slope  Adjustment 


Position  of  Arm  after  Adjusted  for  Slope  Compared  to 


Time  (sec) 


Figure  63.  Position  of  Vibrating  Arm  when  Adjusted  for  Slope  Compared  to 

Alternate  Methods 


For  another  comparison,  the  raw  vibrating  arm  rate  gyro  data  was  numerically 
integrated  to  produce  angular  position.  As  discussed  previously,  when  numerically 
integrated  a  plot  with  bias  error  is  produced  as  seen  in  Figure  64.  Additionally,  Figure  64 
illustrates  the  slope  associated  with  the  trace. 
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Vibrating  Arm  Angular  Displacement  with  Slope  - 


Figure  64.  Vibrating  Arm  Angular  Displacement  with  Slope  Overlay 

As  in  Figure  62,  if  the  vibrating  arm  angular  displacement  plot,  derived  from  raw 
rate  gyro  data,  is  transcribed  to  eliminate  the  drift  produced  from  the  bias  error,  a 
comparison  can  be  made  to  the  technique  discussed  previously  of  differentiating  the  rate 
gyro  first.  As  one  can  see  from  Figure  65,  the  plots  are  nearly  identical  illustrating  that 
both  techniques  can  produce  very  similar  results;  however,  performing  the  differentiating 
first  eliminates  the  manual  transcription  approach. 
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Vibrating  Arm  Angular  Displacement  Adjusted  for  Slope 
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Figure  65.  Vibrating  Ann  Angular  Displacement  Adjusted  for  Slope  Compared  to 
Method  of  Determining  Position  from  Differentiating  Gyro  Data  First 

E.  IMU  ANGLE  MEASUREMENTS 

One  last  piece  of  data  analysis  was  to  compare  yaw  output  from  the  Arduino  code 
to  the  methods  for  detennining  system  motion  from  acceleration  and  gyroscope  data 
presented  in  this  chapter.  As  discussed  in  the  calibration  chapter,  the  IMUs’ 
magnetometers  were  calibrated  in  accordance  with  the  tutorial  in  reference  [23].  The 
magnetometer  data  coupled  with  accelerometer  data  was  used  in  Arduino  to  calculate  the 
yaw,  pitch,  and  roll  of  the  IMU.  The  IMUs  output  was  recoded  to  output  the  yaw  data 
from  each  IMU.  With  this  said,  lower-cost  IMUs  such  as  the  9DOF  Razor  tend  to  be 
more  susceptible  to  magnetic  influences  that  in  turn  affect  the  output  of  the  angle,  or  yaw, 
measurements.  Figures  66-68  show  the  results  of  yaw  data  of  the  vibrating  arm,  plate, 
and  robot  arm  compared  to  the  methods  used  earlier  to  derive  the  system  displacements. 
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Vibrating  Arm  Displacement  Obtained  from  Raw  Data 


Time  (sec) 


Figure  66.  Vibrating  Ann  Displacement  Compared  to  Yaw  Measurements 


Plate  Displacement  Obtained  from  Raw  Data 


Figure  67.  Plate  Displacement  Compared  to  Yaw  Measurements 
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Robot  Arm  Displacement  Obtained  from  Raw  Data 


Time  (sec) 


Figure  68.  Robot  Arm  Displacement  Compared  to  Yaw  Measurements 

While  the  yaw  data  is  somewhat  comparable,  it  is  not  as  accurate  as  using  the  raw 
acceleration  and  gyroscope  data  to  derive  the  system  motion.  The  visually  observed 
experimental  displacement  seems  to  be  closest  to  the  processing  technique  that  uses  the 
method  of  differentiating  the  rate  gyro  data  first. 

F.  SUMMARY 

In  Chapter  IV,  test  bed  instrumentation  was  introduced  by  illustrating  the  sensors 
used  to  capture  the  motion  of  the  test  bed  appendages  and  plate.  It  also  demonstrated  how 
these  signals  are  processed  via  the  NI  cRIO.  Additionally,  post-processing  procedures 
were  developed  highlighting  the  pitfalls  one  may  encounter  by  naively  double  integrating 
angular  acceleration  data  to  arrive  at  angular  position.  Furthermore,  it  was  shown  that 
using  raw  accelerometer  or  rate  gyro  data  to  compute  motion  data,  such  as  angular 
position,  are  more  beneficial  than  using  the  IMUs  yaw  measurements. 
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The  discussion  to  follow  in  Chapter  V  demonstrates  the  results  from  the  initial 
processes  of  concept  A  and  B,  and  finishes  with  the  fully  developed  process  for  analyzing 
the  data  from  concept  C,  the  primary  experimental  method  moving  forward. 
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V.  LABORATORY  EXPERIMENTS 


The  previous  chapters  demonstrated  the  purpose  and  method  to  designing  and 
constructing  the  experimental  test  bed.  Chapter  V  presents  some  example  responses  from 
each  of  the  designed  flexible  joint  prototypes  and  compares  and  contrasts  the  suitability 
of  each  design.  Insight  into  a  path  ahead  for  future  theses  is  also  presented. 

A.  CONCEPT  A— JOINT  WITH  TWO  COUNTER  SPRINGS 

Before  experiments  could  be  conducted,  the  accelerometers  were  calibrated  in 
accordance  with  the  tutorial  of  reference  [18].  Once  calibrated,  static  testing  was 
conducted  to  determine  if  the  flexible  joints  responded  appropriately,  that  is,  produced  a 
damped  oscillatory  motion  in  response  to  the  movement  of  the  two-link  arm.  For  the 
purposes  of  the  static  experiment,  the  applied  force  was  performed  by  simply  manually 
displacing  the  link  and  followed  by  release  of  the  link.  Figure  69  is  a  simple  schematic  of 
a  top  down  view  of  the  system  setup  with  the  base  plate  is  fixed.  This  approach  was  used 
for  testing  both  for  concepts  A  and  B. 


Manual  force 
application 


Base  Plate  Fixed  -  Static  Test 


Figure  69.  Schematic  of  Setup  for  Static  Testing  Concepts  A  and  B 
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Figure  70  shows  the  acceleration  response  measured  for  concept  A.  One  can  see 
from  Figure  70  that  the  response  after  the  link  is  released  damps  out  as  expected  with  an 
exponential  decay  in  the  amplitude  of  the  vibration.  Additionally,  in  Figure  70,  the 
disparity  in  the  response  prior  to  damping  is  simply  a  reflection  of  the  user’s  input  while 
displacing  the  link.  The  finding  from  this  static  experiment  shows  the  flexible  joint 
functions  well  enough  to  conduct  experiments  with  air  pressure  applied  to  the  base. 


Figure  70.  Concept  A — Static  Test  Response 


With  the  static  test  showing  an  appropriate  response,  experiments  with  pressure 
applied  to  the  plate  and  input  imparted  by  the  two-link  electrically  actuated  arm  were 
conducted  next.  Figure  71  illustrates  is  a  simple  schematic  of  a  top  down  view  of  the 
system  when  the  base  plate  is  floating  and  the  input  force  to  the  system  is  applied  via 
robot  arm  motion.  This  approach  was  used  for  testing  concepts  A  and  B. 
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Robot  Arm  Motion 


Base  Plate  Floating 


Figure  71.  Schematic  of  Setup  for  Dynamic  Testing  Concepts  A  and  B 

Figure  72  illustrates  the  measured  acceleration  with  a  free-floating  plate.  From  the 
plot,  one  can  clearly  see  the  initial  increase  in  acceleration,  coincident  with  the  initial 
acceleration  of  the  actuators,  followed  by  a  deceleration  when  the  two-link  arm  stops,  and 
then  finally  a  settling  of  the  flexible  joint. 
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Figure  72.  Concept  A — Dynamic  Test  Response 
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Figure  72  demonstrates  a  reasonable  result.  When  a  satellite  arm  moves,  counter 
forces  are  transcribed  to  not  only  other  appendages  but  also  the  entire  spacecraft.  On  this 
test  set,  when  electric  actuators  displace  the  two-link  arm,  the  entire  free-floating  plate 
moves  in  the  opposite  in  accordance  with  Newton’s  3rd  law.  Thus,  the  acceleration 
response  includes  a  component  due  to  the  motion  of  the  plate.  In  order  to  separate  the 
two,  an  additional  Razor  IMU  must  be  used  to  measure  the  motion  of  the  plate  as 
described  in  Chapter  IV. 

B.  CONCEPT  B— SPRING  FLEXION  PIN 

Similar  to  concept  A,  the  accelerometer  for  this  concept  was  first  calibrated,  and 
then  a  static  test  was  conducted.  Figure  73  illustrates  the  results. 


Concept  B  Static  Test 


Figure  73.  Concept  B — Static  Test  Response 


From  the  plot  in  Figure  73,  one  can  see  that  the  response  for  concept  B  damps  the 

motion  induced  by  the  manually  applied  input  in  an  expected  fashion.  In  comparison  to 

concept  A,  the  response  appears  to  die  out  more  quickly  indicating  a  more  dominant 

viscous  damping  coefficient  in  the  joint.  This  is  a  result  of  different  spring  coefficients 

used  in  the  concept  development  as  well  the  general  design  which  affects  the  loading  of 
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the  joint  bearings.  Figure  74  illustrates  the  response  when  pressure  is  applied  to  the  plate 
and  the  two-link  arm  is  moved  through  its  trajectory. 


Concept  B  Initial  Test 


Figure  74.  Concept  B — Dynamic  Test  Response 

Similar  to  the  results  for  concept  A,  this  plot  demonstrates  the  initial  acceleration 
of  the  two-link  arm,  followed  by  deceleration  when  the  arm  stops,  and  then  a  damped 
response.  The  damped  response,  similar  to  the  static  response,  dies  out  faster  compared  to 
concept  A,  again  due  to  the  difference  in  springs  used  and  the  concept  design. 

One  obvious  difference  between  the  results  of  the  static  tests  compared  to  the  tests 
where  the  plate  is  floating  and  the  robotic  arm  movement  causes  the  excitation  is  the 
observed  signal  to  noise  ratio.  It  was  mentioned  earlier  that  during  the  calibration 
process,  it  was  not  possible  to  calibrate  the  accelerometers  to  zero  due  to  noise  inherent  in 
each  IMU.  This  noise  is  also  referred  to  as  sensor  drift  caused  by  a  small  DC  bias  in  the 
acceleration  signal  [30].  The  amplitude  of  the  static  experiments  is  large  in  comparison  to 
the  floating  plate  tests;  therefore,  the  noise  is  not  as  apparent  in  the  results.  The  signal  to 
noise  ratio  is  large.  When  the  signal  to  noise  ratio  is  small  on  the  other  hand,  it  is  difficult 
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to  discern  the  vibrating  arm  motion  from  the  noise  output  of  the  sensor  and  therefore  one 
can’t  perform  proper  analysis  of  the  results.  With  this  said,  concepts  A  and  B  seem  to  be 
inadequate  for  permanent  implementation  on  the  test  bed. 

C.  CONCEPT  C— MACHINED  TORSION  SPRING 

Concept  C  incorporated  the  helical  machined  spring  as  the  flexible  joint.  This 
concept  allows  for  pure  moments  and  linear  rates.  As  noted  in  Chapter  III.c,  the 
manufacturers  produced  a  torsion  spring  rate  that  resulted  in  a  spring  that  was  too  stiff  to 
provide  the  expected  displacement.  The  spring  was  subsequently  trimmed  at  the  NPS 
machine  shop  to  provide  increased  deflection.  Additionally,  500-gram  weights  were 
added  to  the  end  of  the  robotic  arm  and  then  vibrating  arm  to  add  increased  inertia  to  the 
system.  Adding  the  weight  contributed  to  an  enhanced  signal  to  noise  ratio  so  the 
experimenter  can  observe  the  results  more  clearly  by  reducing  the  noise  floor.  Figures  75 
and  76  show  the  test  bed  configured  for  the  final  experiments  with  added  weights. 


Figure  75.  Test  Bed  Configuration  for  Final  Experiments 
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Figure  76.  Close-up  View  of  Weight  Added  to  the  End  of  Vibrating  Ann 

The  first  step  for  the  final  experiments  was  to  upload  the  Arduino  code  onto  each 
IMU  to  display  all  three  components  acceleration  and  gyroscope  data.  Ultimately  only 
tangential  data  is  needed.  However,  the  plate  IMU  is  laid  flat  while  both  arms’  IMUs  are 
vertical;  therefore  the  output  channels  from  each  IMU  are  different  depending  on 
orientation.  Additionally,  post-processing  the  data  to  determine  the  gravity  component 
can  be  used  to  verify  the  accuracy  of  the  processed  data. 

An  experiment  was  conducted  by  opening  the  front  panel  of  the  Lab  VIEW 
program  as  well  as  the  Robotis  Dynamixel  Wizard  software  to  control  the  Dynamixel  Pro 
M42-10-S260-R.  Again,  just  one  actuator  was  functioning  for  the  final  experiment; 
therefore,  the  two-link  robotic  arm  in  effect  functioned  as  a  one-link  arm.  On  the 
Lab  VIEW  front  panel,  the  “run”  button  was  selected  then  serial  data  from  each  IMU 
began  to  stream  onto  the  display.  The  serial  data  is  separated  by  20  milliseconds;  with 
this  said,  in  order  to  reduce  the  amount  of  data  for  post-processing,  the  robotic  arm  was 
quickly  commanded  to  rotate  90  degrees.  The  robotic  arm  motion  imparts  rotational 
motion  on  the  plate  and  therefore  a  vibration  of  the  flexible-joint,  vibrating  arm.  Once  the 
vibrating  arm  settles,  the  Lab  VIEW  program  is  commanded  to  stop.  The  data  from  each 
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IMU  is  subsequently  written  to  text  files,  the  data  is  copied  and  pasted  into  Excel, 
transposed,  and  finally  copied  into  the  MATLAB  script  detailed  in  the  Appendix. 

Experimental  Results 

Figures  77-79  illustrate  the  acceleration  data  from  each  axis  of  the  respective 
IMUs.  The  vibrating  arm  and  robotic  arm  data  sets  both  illustrate  that  the  axis  normal  to 
the  plane  of  motion  is  the  “al”  component  and  the  plate  normal  acceleration  component 
is  “a2”  since  the  data  plotted  corresponds  to  gravity  in  metric  units.  Additionally,  the 
tangential  motion  component  for  each  arm  is  “a2”  whereas  the  plate  tangential 
acceleration  component  is  “al”  by  inspection  of  the  sinusoidal  behavior  of  the  plots. 


Vibrating  Arm  Acceleration  Measurements 
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Figure  77.  Vibrating  Arm  Acceleration  Measurements 
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Plate  Acceleration  Measurements 


Figure  78.  Plate  Acceleration  Measurements 
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Robot  Acceleration  Measurements 
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Figure  79.  Robot  Arm  Acceleration  Measurements 


97 


Figures  80-83  present  the  rate  gyro  data  for  the  test.  The  vibrating  arm  and 
robotic  arm  results  illustrates  that  the  desired  angular  rate  component  is  “gl”  and  for  the 
plate,  the  desired  angular  rate  component  is  “g2”.  To  note,  in  both  the  acceleration  and 
rate  plots,  one  can  see  how  the  robotic  arm  is  commanded  comparably  to  a  “bang-bang” 
maneuver.  That  is,  the  responses  show  a  rapid  application  of  torque  to  the  system 
followed  by  a  rapid  deceleration.  This  effect  is  translated  to  the  plate,  and  then  to  the 
vibrating  arm. 


Figure  80.  Vibrating  Ann  Rate  Measurements  for  Each  Axis 
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Plate  Gvro  Measurements 
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Figure  81.  Plate  Rate  Measurements  for  Each  Axis 
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Figure  82.  Robot  Arm  Rate  Measurements  for  Each  Axis 
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Figure  83  compares  the  vibrating  arm  angular  acceleration  response  obtained  by 
two  methods.  The  “Alpha  from  differentiating  gyro”  is  the  angular  acceleration  derived 
by  finite  differencing  the  rate  gyro  data.  The  “Raw  alpha  from  accelerometer”  trace  is 
simply  the  tangential  acceleration  mapped  to  the  vibrating  ann’s  flexible  joint  by  dividing 
by  the  distance  from  the  accelerometer  to  the  center  of  the  joint. 


Figure  83.  Vibrating  Arm  Acceleration  Determined  from  Differentiated  Rate 
Gyro  Data  versus  Raw  Acceleration  Data  Mapped  to  Joint 

Figures  84  and  85  represent  the  angular  acceleration  for  the  plate  and  robot  arm, 
respectively.  The  plots  were  derived  in  the  same  manner  as  for  the  vibrating  arm.  As 
noted  previously,  the  rapid  on/off  application  of  the  robotic  arm  is  easily  seen  in  the 
angular  acceleration  plots  for  both  the  plate  and  robot  arm.  Note  also  the  comparably 
large  angular  acceleration  magnitude  of  the  robot  ann  in  comparison  with  the  other 
signals. 
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Figure  84.  Plate  Acceleration  Detennined  from  Differentiated  Rate  Gyro  Data 
versus  Raw  Acceleration  Data  Mapped  to  Joint 


Figure  85.  Robot  Arm  Acceleration  Determined  from  Differentiated  Rate  Gyro 
Data  versus  Raw  Acceleration  Data  Mapped  to  Joint 
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Figure  86  illustrates  the  angular  velocity  of  the  vibrating  arm  derived  via  three 
different  approaches.  The  “raw  gyro”  plot  is  simply  that,  the  raw  data  converted  into  units 
of  °/sec.  The  “rate  from  diff  gyro”  was  detennined  by  numerically  integrating  the  finite 
differenced  gyro  data  noted  in  Figure  83.  The  “rate  from  accel”  is  the  angular 
acceleration  signal  derived  from  the  tangential  acceleration  component  numerically 
integrated.  The  plot  of  raw  gyro  data  compared  to  the  “rate  from  diff  gyro”  confirms  the 
process  of  differentiating  to  derive  the  angular  acceleration  and  then  integrating  to  derive 
the  angular  rate  by  canceling  out  the  +/-  errors  of  each  step  in  the  process.  The  “rate  from 
accel”  plot  confirms  the  discussion  in  Chapter  IV  that  simply  numerically  integrating  the 
data  without  accounting  for  the  inherent  bias  in  the  process  due  to  unknown  initial 
conditions  will  cause  the  resultant  plot  to  drift. 


Vibrating  Arm  Angular  Rate  - 
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Figure  86.  Processing  the  Vibrating  Arm  Angular  Rate  from  the  Measured  Data 

Figures  87  and  88  demonstrate  similar  results  for  the  plate  and  robot  arm.  Again, 
the  rapid  onset  of  torque  is  easily  observed  in  both  figures. 
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Plate  Angular  Rate  - 
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Figure  87.  Processing  the  Plate  Angular  Rate  from  Measured  Data 


Robot  Arm  Angular  Rate  - 
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Figure  88.  Processing  the  Robot  Arm  Angular  Rate  from  Measured  Data 
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Figure  89  illustrates  the  vibrating  motion.  The  “Pos  from  raw  gyro”  plot  was 
determined  by  numerically  integrating  the  raw  gyro  data.  The  “Pos  from  diff  gyro”  was 
detennined  by  numerically  integrating  the  previously  mentioned  differentiated  gyro  data 
that  was  then  integrated  to  derive  the  angular  velocity.  Both  methods  show  comparable 
results  to  the  actual  motion  of  the  system.  The  motion  of  the  vibrating  arm,  as  seen  in 
Figure  89,  represents  not  just  the  motion  of  the  arm,  but  also  the  motion  of  the  arm  plus 
the  motion  of  the  plate.  That  is,  after  the  robot  arm  stops,  the  vibrating  ann  continues  to 
vibrate  imparting  a  torque  onto  the  plate.  However,  the  plate  also  drifts  while  the  arm  is 
vibrating.  The  combined  motions  explain  the  drift  observed  in  Figure  89  while  the 
vibrating  arm  vibrates  and  subsequently  damps  out.  This  point  is  important  to  note,  as  the 
drift  in  the  “Pos  from  diff  gyro”  is  the  plate  actually  drifting  vice  the  “drift”  as  a  result  of 
numerical  integration.  With  this  said,  as  will  be  seen  when  the  vibrating  arm  and  plate 
motions  are  separated,  the  “Pos  from  raw  gyro”  plot  represents  components  due  to  actual 
plate  drift  and  numerical  integration  drift. 


Vibrating  Arm  Displacement  from  Integrating  Gyro  Data 


Figure  89.  Vibrating  Arm  Displacement  from  Integrating  Gyro  Data  and  from 

Integrating  Differentiated  Gyro  Data 
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Figures  90  and  91  illustrate  the  motion  of  the  plate  and  the  robot  arm  derived 
using  the  same  processing  as  Figure  89.  In  Figure  90,  the  error  from  numerically 
integrating  the  raw  gyro  data  is  more  apparent  as  seen  in  the  initial  slope  of  the  “Pos  from 
raw  gyro”  plot.  To  note,  for  completeness  the  acceleration  data  from  each  IMU  was 
numerically  integrated  twice.  The  results  skewed  the  plots  of  the  previously  discussed 
methods  to  such  a  degree  that  they  were  unable  to  be  read.  That  is,  the  error  from 
integrating  the  acceleration  twice  was  so  large  that  it  overshadowed  the  other  plots, 
demonstrating  that  twice  integrating  accelerometer  data  is  unusable  unless  one  can 
properly  account  for  the  slope  and  initial  conditions  associated  with  each  integration. 


Plate  Displacement  from  Integrating  Gyro  Data 


Figure  90.  Plate  Displacement  from  Integrating  Gyro  Data  and  from  Integrating 

Differentiated  Gyro  Data 
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Robot  Arm  Displacement  from  Integrating  Gyro  Data 


Figure  91.  Robot  Arm  Displacement  from  Integrating  Gyro  Data  and  from 

Integrating  Differentiated  Gyro  Data 

Figure  92  illustrates  the  results  of  isolating  the  vibrating  arm  motion  from  the 
plate  motion.  The  figure  demonstrates  that  differentiating  the  raw  gyro  data  first  then 
integrating  the  result  twice  is  clearly  the  best  available  method  for  eliminating  the  drift 
error  and  therefore  to  isolate  the  vibrating  arm  motion.  The  “Pos  from  raw  gyro” 
approach  still  has  a  bias  present  after  the  plate  motion  is  subtracted  from  the  vibrating 
arm  motion  due  to  the  differences  in  error  present  in  this  approach.  The  MATLAB  code 
below  demonstrates  the  simple  code  used  to  isolate  the  vibrating  arm  motion  where 
“Subtract  raw”  subtracts  the  plate  displacement  determined  by  integrating  the  raw  gyro 
data  from  the  vibrating  arm  raw  gyro  data.  “Subtract  accel”  performs  a  comparable 
operation  for  the  method  of  differentiating  then  integrating  the  raw  gyro  data. 

subtract_raw  =  vib_pos_gyro_raw  -  plate_pos_gyro_raw; 

subtract  accel  =  vib_pos_rate_gyro_accel  -  plate_pos_rate_gyro_accel; 
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Isolated  Displacement  of  Vibrating  Arm 


Figure  92.  Isolated  Displacement  of  Vibrating  Arm  from  Plate  Displacement 

D.  SUMMARY 

This  chapter  illustrated  that  the  three  concepts  developed  for  implementing  a 
flexible  joint  built  upon  themselves  in  a  crawl,  walk,  run  fashion  to  produce  a  viable 
design  and  flexible  joint  mechanism  to  support  future  experiments.  The  helical  torsional 
spring  ultimately  did  produce  the  desired  deflection.  Additionally,  the  developed  post¬ 
processing  for  the  IMU  data  was  able  to  accurately  isolate  and  depict  the  actual  motion  of 
the  system  observed  during  the  experiments. 
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VI.  CONCLUSION 


A.  CONCLUSION 

The  goal  of  this  thesis  was  to  develop  multiple  concepts  for  a  flexible  joint  motion 
simulator,  from  simple  to  more  complex,  to  provide  a  basis  for  laboratory 
experimentation  on  advanced  algorithms.  As  unique  or  clever  a  design  concept  may  be, 
proper  effort  needs  to  be  placed  into  the  sensing  processes  such  that  useful  data  can  be 
extracted  from  experiments.  Ultimately  three  mechanism  concepts  were  investigated. 
Concepts  A  and  B  were  preliminary  ideas  developed  to  test  the  basic  functionality  of  the 
air-bearing  test  bed,  test  for  the  expected  motion  of  the  system  as  a  whole,  and  to  develop 
initial  post-processing  data  analysis  work  flows.  The  responses  of  concepts  A  and  B  in 
both  the  static  and  dynamic  testing  proved  to  be  far  from  ideal.  Because  the  deflection 
amplitude  was  small,  the  noise  from  the  IMUs  was  more  apparent.  Concept  C  proved  to 
be  the  best  design.  Concept  C’s  flexible  joint  incorporated  a  helical  torsion  spring 
allowing  linear  rates  and  pure  moments  to  be  realized.  Once  concept  C  was  assembled,  it 
was  apparent  that  good  signal  to  noise  ratios  could  be  obtained.  Experiments  were 
performed  by  incorporating  the  NI  cRIO  and  refined  post-processing  steps  in  order  to 
measure  link  flexible  effects.  The  responses  in  all  cases  were  sufficient  to  provide  an 
understanding  of  spacecraft  dynamics  and  vibration  analysis  when  the  motion  of  one 
body  excites  other  components  of  the  spacecraft.  Additionally,  the  efforts  made  to  this 
point  serve  to  provide  the  basis  necessary  to  proceed  with  more  complex  thesis  work 
incorporating  optimal  control  theory.  Future  work  will  be  aimed  at  finding  optimal  robot 
ann  motions  that  can  be  accomplished  in  minimal  time  and/or  with  minimal  effort,  that 
also  reduce  the  induced  vibrations  of  other  attached  antenna  linkages.  To  do  this,  a  model 
of  the  system  as  a  whole  should  be  considered. 

B.  FUTURE  WORK 

The  developed  test  bed  provides  opportunities  for  a  variety  of  flexible  space 
system  experiments.  Through  optimal  control  applications,  one  can  research  the  effects  of 
robotic  ann  motion  on  the  behavior  of  flexible  appendages. 
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Further  development  of  the  sensing  processes  and  software  environment  should 
be  made  to  better  understand  the  responses  of  the  system.  Furthermore,  understanding  of 
the  Robotis  software  used  to  command  the  Dynamixel  actuators  would  allow  one  to 
implement  optimal  control  trajectories  to  the  two-link  robot  with  the  goal  to  minimize  the 
amount  of  vibration  on  the  flexible  joint  link. 

Additionally,  the  plate  was  created  to  allow  for  three  stanchions  to  be  assembled 
to  the  plate  and  then  attach  a  second  level  for  additional  components.  With  pressure 
applied  to  the  plate  and  when  the  two-link  ann  was  displaced  by  a  commanded  trajectory, 
the  base  plate  moved  in  the  opposite  direction  of  the  arm  displacement,  as  one  would 
expect.  This  fact  is  noted  as  a  complexity  of  spacecraft  dynamics.  As  a  satellite  is  floating 
through  space,  movements  from  attached  bodies  are  felt  throughout  the  spacecraft.  The 
complexity  of  incorporating  momentum  exchange  devices  to  counter  this  movement  is 
not  lost  on  the  author.  The  laboratory  test  bed  that  has  been  built  can  provide  a  means  to 
incorporate  such  devices  on  future  theses.  As  well,  the  NI  cRIO  has  12  more  ports  for 
many  other  devices  to  be  incorporated  into  the  test  bed.  Furthermore,  the  laboratory  setup 
can  be  evolved  using  Wi-Fi  components.  Wireless  communication  between  the  sensors 
and  the  working  computer  will  eliminate  the  issue  of  hanging  cables  imparting  torques  on 
to  the  test  bed. 

Until  that  end,  the  efforts  made  so  far  in  the  build,  experimentation,  and 
understanding  of  flexible  spacecraft  systems  have  laid  the  groundwork  for  more  complex 
and  integrated  experiments  in  this  laboratory  environment.  In  all,  the  possibilities  that  this 
test  bed  provides  are  very  exciting  and  ready  for  the  next  student! 
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APPENDIX.  EXAMPLE  DATA  PROCESSING  CODE 


In  this  appendix,  numerical  integration  code  was  created  to  attempt  to  mimic  the 
numerical  integration  function  of  Matlab’s  “cumtrapz”  function.  The  displayed  plots 
compare  the  results  of  the  two  methods. 

Due  to  the  size/length  of  the  time,  acceleration,  and  gyroscope  data  arrays,  they 
were  deleted  from  the  appendix.  A  has  been  added  to  highlight  the  change.  This  data 
changes  with  each  experiment;  therefore,  the  critical  piece  to  the  coding  is  still 
represented. 


%  Simple  model  to  show  problems  with  double  integrating  acceleration. 

%  This  code  performs  numerical  integration  of  experimental  data  and 
%  compares  it  to  Matlab's  cumtrapz  function.  As  well,  a  simple  Simulink 
%  model  was  created  to  show  the  results  from  passing  a  sine  input 
through  a 

%  double  integrator  compared  to  passing  the  same  simple  sine  wave 
through 

%  Matlab's  cumptrapz  function. 

%  CDR  Martin  Griggs 
%  Thesis  -  31  Oct  2016 


clear  all;  close  all; 

%%%  Run  Simulink  model  %%% 

[tout,  yout,  output ] =sim( ' test3 ') ; 

%%  Experiment  Data  analized  using  numerical  integration  code 
vib_accel_0  =  [*]; 
vib_accel_l  =  [*]; 
vib_accel_2  =  [*]; 


vib_accel_0  =  vib_accel_0*l/225*9 . 81 ;  %for  +  /-  16g  full  scale,  we 
should  divide  by  256  LSB/g 

%by  instead  we  divide  by  225  which 


gives  lg 


%in  "z"  direction  per  the  "raw"  data 
% ( see  also  ADXL345  product 


specification ) 

vib_accel_l  =  vib_accel_l*l/225*9 . 81 ; 
vib_accel_2  =  vib_accel_2* 1/225*9 . 81 ; 


time  =  [ *  ]  ; 

dt  =  0.02; 

time  =  time( 1:381); 
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length_vib  =  length ( vib_accel_2 ) ; 

%  Vibrating  Arm  Velocity 

vib_vel(l)  =  0 . 5* ( vib_accel_2 ( 1 )  +  vib_accel_2 ( 2 ) ) *dt ; 
for  i  =  1 : length_vib-3 ; 

vib_vel(2)  =  0 . 5* ( vib_accel_2 ( 2 )  +  vib_accel_2 ( 3 ) ) *dt  +  vib_vel(l) 
vib_vel(i+2)  =  0 . 5* ( vib_accel_2 ( i+2 )  +  vib_accel_2 ( i+3 ) ) *dt  + 
vib_vel ( i+1 ) ; 

end 

v_size  =  size ( vib_vel ) ; 

vib_vel ( v_size ( 2 )  +  1)  =  vib_vel ( end ) ; 

%  Vibrating  Arm  Displacement 

vib_displ(l)  =  0 . 5  * ( vib_vel ( 1 )  +  vib_vel ( 2 ) ) *dt ; 
for  j  =  1 : length_vib  -  3; 

vib_displ(2)  =  0 . 5  * ( vib_vel ( 2 )  +  vib_vel ( 3 ) ) *dt  +  vib_displ ( 1 ) ; 
vib_displ ( j+2 )  =  0 . 5* ( vib_vel ( j+2 )  +  vib_vel ( j+3 ) ) *dt  + 
vib_displ ( j+1 ) ; 

end 

d_size  =  size ( vib_displ ) ; 

vib_displ ( d_size ( 2 )  +  1)  =  vib_displ ( end ) ; 

%%  Experimental  Data  using  cumtrapz  -  only  accounting  for  tangential 
acceleration  (accel  [2]) 

vib_vel_cum  =  cumtrapz ( time ,  vib_accel_2 ) ; 
vib_pos_cum  =  cumtrapz ( time ,  vib_vel  cum) ; 

%%  Plots  for  numerical  versus  cumtrapz 
figure 

subplot(2,  1,  1) 

plot(time,  vib_vel,  time,  vib_vel_cum,  'Linewidth',  2) 

xlabel('Time  (sec)') 

ylabel (' Velocity  (meters/sec)') 

legend ( 'Numerical  Integration  Code',  'Cumtrapz') 

title ({' Experimentally  Derived  Velocity  Analysis  'Numerical  vs. 

Cumtrapz ' } ) 

subplot(2,  1,  2) 

plot(time,  vib_displ,  time,  vib_pos_cum,  'Linewidth ',  2) 
xlabel('Time  (sec)') 
ylabel (' Position  (meters)  ) 

legend ( 'Numerical  Integration  Code',  'Cumtrapz') 

title ({' Experimentially  Derived  Position  Analysis  'Numerical  vs. 

Cumtrapz ' } ) 

%%  Cumtrapz  simple  sine  wave 
c  =  0:0.1:20; 

acceleration_cum  =  sin(c); 

velocity_cum  =  cumtrapz (c,  acceleration_cum) ; 
position_cum  =  cumtrapz (c,  velocity_cum) ; 


%%  Plots  of  simple  sine  wave  passed  through  simulink  and  corrected  for 
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intital  conditions  compared  to 

%  cumtrapz 

figure 

subplot(3,  1,  1) 

plot (tout,  acceleration,  'Linewidth',  2) 
xlabel ( ' Time  (sec)') 
ylabel( 'Acceleration  (rads/secA2) ' ) 
title( 'Acceleration' ) 
subplot(3,  1,  2) 

plot (tout,  velocity,  'Linewidth',  2) 

xlabel ('Time  (sec)') 

ylabel (' Velocity  (rads/sec)') 

title( 'Velocity' ) 

subplot(3,  1,  3) 

plot (tout,  acceleration,  'Linewidth',  2) 
xlabel ('Time  (sec)') 
ylabel (' Position  (rads)') 
title ( 'Position' ) 

figure 

subplot(3,  1,  1) 

plot(c,  acceleration_cum,  'Linewidth',  2) 
xlabel ('Time  (sec)') 
ylabel( 'Acceleration  (rads/sec^2) ' ) 
title( 'Acceleration' ) 
subplot(3,  1,  2) 

plot(c,  velocity_cum,  'Linewidth',  2) 

xlabel ('Time  (sec)') 

ylabel ( 'Velocity  (rads/sec)') 

title( 'Velocity  ) 

subplot(3,  1,  3) 

plot(c,  position_cum,  'Linewidth',  2) 
xlabel ('Time  (sec)') 
ylabel (' Position  (rads)') 
title ( 'Position' ) 
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